servo range
This commit is contained in:
父節點
666ed16115
當前提交
edfda65fef
共有 1 個文件被更改,包括 2 次插入 和 1 次删除
|
@ -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;
|
||||
|
||||
|
|
載入中…
Reference in a new issue