servo range
This commit is contained in:
parent
666ed16115
commit
edfda65fef
1 changed files with 2 additions and 1 deletions
|
@ -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;
|
||||
|
||||
|
|
Loading…
Reference in a new issue