Dirigent

Uit TrompBot
Naar navigatie springen Naar zoeken springen

Beginnen | Hardware | Software | Voorbeeldprogramma | Inkscape & lasersnijden | Errors & Tips | Kekbot | [TrompBot Website] | Trompbots | Percussie & ritme | Fioretti programma


Een [dirigent] zorgt ervoor dat alle muzikanten in een orkest gelijk beginnen en in hetzelfde tempo spelen. Als we met ons robot orkest gaan spelen, moeten we ook zorgen dat iedereen op het zelfde moment start en in hetzelfe tempo speelt.

Probleem

Hebben wij ook een dirigen nodig bij onze robot orkesten? Robots zijn toch heel precies en doen altijd exact hoe ze geprogrammeerd zijn. Dus waarom zouden ze naar een dirigent moeten luisteren?

Doe het volgende experiment om dat uit te zoeken:

  • Zet het programmatje Led aan en uit in twee launchpad microcontrollers
  • Zet de twee launchpads naast elkaar en druk bij beide op de RESET (S1) knop.
  • Laat op hetzelfe moment beide reset knoppen los
  • Beide ledjes knipperen als het goed is nu even snel en gelijktijdig
  • Wacht ongeveer 2 minuten
  • Kijk nu of de ledjes nog steeds gelijktijdig knipperen. Ja? Of hebben we een probleem?

Wat gebeurt hier?

Iedere microcontroller heeft zijn eigen klok en die loopt op een vast tempo (hij telt 16miljoen keer per seconde), maar niet iedere klok loopt exact gelijk (je kent het probleem wel van je eigen horloge of wekker) sommige lopen een beetje sneller, andere lopen een beetje langzamer. Dus als je een tijdje wacht, dan zal de klok van de ene microcontroller iets voor gaan lopen, en de andere iets achter. Dan lopen ze dus uit de maat.

Oplossing

De oplossing is het maken van een dirigent die de andere robots in de maat kan houden. Hiervoor moeten de microcontrollers met elkaar kunnen praten dit kan bijvoorbeeld met de infrarood zender en ontvanger. Kijk hiervoor ook naar de voorbeeld programmas Verzenden en Ontvangen. Dat kan je gebruiken om alle microcontrollers gelijk te laten starten (net zoals bij de knop), maar dat lost het probleem nog niet op, want daarna kunnen ze alsnog uit de maat gaan lopen, omdat hun klokken niet even snel lopen.

Een aanpassing van dit programma kan gebruikt worden om (net als een dirigent) steeds de maat aan te geven.

/*
 * dirigent.ino
 * Wacht op indrukken van knop S2 en stuur dan continue IR pulsjes, met een snelheid van 1000 per seconde
 * Deze pulsjes kunnen ontvangen worden door andere robots (zorg dat de zender en ontvanger elkaar goed zien!)
 */
void setup() 
{
  pinMode(6,OUTPUT); // pen 6: IR led (uitgang)
  pinMode(2,OUTPUT); // pen 2: rode LED (uitgang)
  pinMode(14,OUTPUT); // pen 14: groene LED (uitgang)
  pinMode(5, INPUT_PULLUP); // schakelaar (ingang)
 
  digitalWrite(14,HIGH); // Zet groene led aan
  while ( digitalRead(5) == HIGH ); // Loop zolang de knop S2 NIET is ingedruk (groene led is aan) en doe niets
  digitalWrite(14,LOW); // Zet groene led uit
}
 
 
void loop() 
{
  digitalWrite(2,HIGH); // zet rode LED UIT
  tone(6,36000,1);     // Stuur puls op de IR van 36khz en 1miliseconde lang
  delay(1); // wacht 1 milliseconde
  digitalWrite(2,LOW); // zet rode LED AAN
}


De ontvanger

/*
 * ontvanger.ino
 * IR ontvanger. Telt pulsjes die deze binnenkomen via de IR ontvanger
 * Met de wacht() functie kan je wachten tot er een aantal pulsen ontvangen zijn
 * Verschillende microcontrollers kunnen nu exact even lang wachten als ze allemaal naar dezelfde zender kijken.
 *
 */
#include <Servo.h>    // zeg de computer dat we de servo functies willen gebruiken, anders kan hij die niet vinden
 
Servo motorA;  // definieer een servo met de naam motorA 


// wacht tot er een aantal pulsen ontvangen is (iedere overgang van LAAG naar HOOG wordt geteld)
void wacht(int pulsen)
{
  while ( pulsen > 0 ) // Zolang we nog niet op nul zijn
  {
    while( digitalRead(7) == LOW ); // wacht zolang IR ingang LAAG is   
    while( digitalRead(7) == HIGH ); // wacht zolang IR ingang HOOG is
    pulsen = pulsen - 1;  // trek 1 af van de pulsen teller 
  }
}
 
// setup: initialiseer de IO's en verbind de signaal functie met de ingang
void setup() 
{
  pinMode(7,INPUT_PULLUP); // IR sensor op pen 7 als ingang schakelen
  pinMode(2,OUTPUT); // rode LED op pen 2 als uitgang schakelen
  motorA.attach(13); // vebind servo met aansluitpen 13
}


// loop: wacht steeds op een aantal pulsjes, en zet de servo in een andere stand
void loop() 
{
  wacht(250); // wacht totdat er 250 pulsjes ontvangen zijn
  digitalWrite(2,HIGH); // Rode led aan
  motorA.write(40); // Zet de servo op stand 40
  wacht(100); // Wacht totdat er nog 100 pulsjes ontvangen zijn
  motorA.write(80); // zet de servo op stand 80
  digitalWrite(2,LOW); // Rode led uit
}