Kim Nielsen / Mbed 2 deprecated PRO1

Kildekode til robot

Dependencies:   mbed

Fork of PRO1 by E2016-S1-Team5

nucleo_servo.cpp

Committer:
kimnielsen
Date:
2016-10-31
Revision:
1:396a582e8861
Parent:
0:d3dbe632b1a9

File content as of revision 1:396a582e8861:

#include "mbed.h"
#include "nucleo_servo.h"
   
Servo::Servo(PinName pin){
    servoPWM = new PwmOut(pin);
    servoPWM->period_ms(20);  //Do not change ;)
    servoPWM->pulsewidth_us(600);
    degrees = 0;
}
Servo::~Servo(){
    delete servoPWM;  
}

void Servo::set_position(float deg){
    degrees = deg;
    if(degrees > 180)degrees = 180;
    if(degrees < 0)degrees = 0;
    int pw_us = 640 + (degrees / 180 * 1900); 
    servoPWM->pulsewidth_us(pw_us);
}
    
void Servo::turn_left(float deg){
    degrees -= deg;
    set_position(degrees);
}

void Servo::turn_right(float deg){
    degrees += deg;
    set_position(degrees);
}