Update highcmd_development.cpp
This commit is contained in:
parent
0951110ccb
commit
803de91b21
|
@ -17,6 +17,7 @@ int main()
|
||||||
{
|
{
|
||||||
arm.q = lastPos*(1-i/duration) + targetPos*(i/duration);
|
arm.q = lastPos*(1-i/duration) + targetPos*(i/duration);
|
||||||
arm.qd = (targetPos-lastPos)/(duration*arm._ctrlComp->dt);
|
arm.qd = (targetPos-lastPos)/(duration*arm._ctrlComp->dt);
|
||||||
|
arm.setArmCmd(arm.q, arm.qd);
|
||||||
timer.sleep();
|
timer.sleep();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue