servo range

This commit is contained in:
Jasper Güldenstein 2020-11-16 13:02:05 +01:00
parent 666ed16115
commit edfda65fef

View file

@ -50,7 +50,8 @@ void SERVO_Init(void){
void SERVO_SetAngle(int angle){
// set ccr3 register to alter pwm output between 1 and 2 ms
float vminCOR = 999, vmaxCOR = 1999;
angle = 90 - angle;
float vminCOR = 1250, vmaxCOR = 1950;
float diffCOR = vmaxCOR - vminCOR;
int ccr3Value = round(angle*diffCOR/90)+vminCOR;