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){
|
void SERVO_SetAngle(int angle){
|
||||||
// set ccr3 register to alter pwm output between 1 and 2 ms
|
// 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;
|
float diffCOR = vmaxCOR - vminCOR;
|
||||||
int ccr3Value = round(angle*diffCOR/90)+vminCOR;
|
int ccr3Value = round(angle*diffCOR/90)+vminCOR;
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue