Verwijderde inhoud Toegevoegde inhoud
|
|
|
=== Stap 4: Robotarm laten bewegen met Dwengo ===
Gebruik onderstaande code om je seriële verbinding te testen: <br />
<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];
initBoard();
initLCD();
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
printIntToLCD(c[0],0,0); //eerste byte als integer weergeven op scherm
printIntToLCD(c[1],1,0); //tweede byte als integer weergeven op scherm
}
} //terugkeren naar begin en opnieuw beginnen
</source>
Nu zal je een functie moeten schrijven die de x-en y-coördinaat omzet naar 2 bewegingen van een servo-motor.
|
