Servo Motor Example for electric skateboard

Dependencies:   Servo mbed

Fork of Servo_HelloWorld by Simon Ford

main.cpp

Committer:
kaizen
Date:
2015-10-29
Revision:
2:265f6c40ef23
Parent:
1:40d2fd0b99e6

File content as of revision 2:265f6c40ef23:

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

int main() {    
    uint8_t ch;
    volatile float speed_value = 0.5;

    Servo myservo(PC_8);
    Serial pc(USBTX,USBRX);
    
    pc.baud(115200);
    wait(1);
    pc.printf("TEST Start\r\n");
    
    while(1)
    {
        pc.printf("speed : %f\r\n",speed_value);
        myservo = speed_value;

        ch = pc.getc();
        
        if(ch == 'u')
        {
            speed_value += 0.001;
        }
        else if(ch == 'd')
        {
            speed_value -= 0.001;
        }
        
        else if(ch == 's')
        {
            myservo = 0.5;
            wait(0.5);
            
            speed_value = 0.41;
            myservo = speed_value;
            wait(5);

            speed_value = 0.5;
            myservo = speed_value;
            
        }
    }
}