Servo

Dependencies:   mbed MODSERIAL Servo FastPWM

main.cpp

Committer:
s1923196
Date:
2019-10-28
Revision:
10:1754b6220c7a
Parent:
8:3990a8c4ccea
Child:
11:bb036c288cd7

File content as of revision 10:1754b6220c7a:


#include "Servo.h"
#include "mbed.h"
#include "FastPWM.h"

Serial pc(USBTX, USBRX);
Servo mijnServo(D7);
double pos = 0;
double target;
int main(void)
{mijnServo.Enable(1500,20000);
    wait(1);
    for(pos = 2400; pos >=500; pos-=50)
    {
        target = pos/180;
        mijnServo.SetPosition(pos);
        pc.printf("De servo staat op %f graden.\n\r", pos);
        wait(0.1);
    }
    for(pos = 500; pos <= 2400; pos += 50)
    {
        target = pos/180;
        mijnServo.SetPosition(pos);
        pc.printf("De servo staat op %f graden.\n\r", pos);
        wait(0.1);
    } 
    while(true);
   
}