Dwengo/tekenrobot: verschil tussen versies
Verwijderde inhoud Toegevoegde inhoud
Regel 245:
</source>
===== Doorgeven relatieve muisbeweging waardoor de arm beweegt =====
Je gebruikt de Processing code van hierboven en de Dwengocode van hieronder.
<source lang= c>
#include <dwengoBoard.h>
#include <dwengoConfig.h>
#include <dwengoDelay.h>
#include <dwengoLCD.h>
#include <dwengoServo.h>
#include <dwengoUsart.h>
#include <dwengoMotor.h>
#include <math.h>
void main(void)
{
char c[2];
int een,twee;
initBoard();
initLCD();
initServo();
setPosition(2, 220);
setPosition(1,255);
een = 255;
twee = 255;
while(TRUE) { //oneindige lus
initUsart(); //verbinding initialiseren
while (!DataRdyUSART()); //wachten tot er informatie klaarstaat
getsUSART(c,2); //een string van 2 bytes inlezen
clearLCD(); //scherm leegmaken
een = een + c[0]; //relatieve beweging verandert waarde voor servov 1
twee = twee + c[1]; //relatieve beweging verandert waardr voor servo 2
if (een>255) // als een een maximumwaarde bereikt wordt er niks meer bijgeteld. Dit is om te vermijden dat de servo van 0 herbegint
{een = 255;} // hierdoor krijg je anders een wilde beweging van de arm
if (een<0) //zelfde maar voor minimumwaarde
{een = 0;}
if (twee>255)
{twee = 255;}
if (twee<0)
{twee = 0;}
setPosition(1, een); // servo1 aansturen
setPosition(2, twee); // servo2 aansturen
printIntToLCD(c[0],0,0); //eerste byte als integer weergeven op scherm
printIntToLCD(c[1],1,0); //tweede byte als integer weergeven op scherm
}
delay_ms(500); //korte vertraging om arm kans te geven om te bewegen.
} //terugkeren naar begin en opnieuw beginnen
| |||