中级会员
- 积分
- 281
- 威望
- 144
- 贡献
- 63
- 兑换币
- 67
- 注册时间
- 2012-11-13
- 在线时间
- 37 小时
|
void SetMotorVoltage(float fLeftVoltage, float fRightVoltage) {
short nPeriod;
int nOut;
nPeriod = (short)getReg(PWM_PWMCM);
if(fLeftVoltage > 0) {
setReg(PWM_PWMVAL1, 0);
nOut = (int)(fLeftVoltage * nPe riod);
setReg(PWM_PWMVAL0, nOut);
} else {
setReg(PWM_PWMVAL0, 0);
fLeftVoltage = -fLeftVoltage;
nOut = (int)(fLeftVoltage * nPeriod);
setReg(PWM_PWMVAL1, nOut);
}
if(fRightVoltage > 0) {
setReg(PWM_PWMVAL2, 0);
nOut = (int)(fRightVoltage * nPeriod);
setReg(PWM_PWMVAL3, nOut);
} else {
setReg(PWM_PWMVAL3, 0);
fRightVoltage = -fRightVoltage;
nOut = (int)(fRightVoltage * nPeriod);
setReg(PWM_PWMVAL2, nOut);
}
MOTOR_SETLOAD; // Reload the PWM value
}
用的是K60芯片 用的野火的库
官方文档里的这个。。。 getReg 这个是什么API... PWM_PWMCM 这个是代表什么意思~~~ PWM_PWMVAL1 同上~~~ MOTOR_SETLOAD 最后是这个~~
|
|