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.qd = (targetPos-lastPos)/(duration*arm._ctrlComp->dt);
|
||||
arm.setArmCmd(arm.q, arm.qd);
|
||||
timer.sleep();
|
||||
}
|
||||
|
||||
|
@ -24,4 +25,4 @@ int main()
|
|||
arm.setFsm(UNITREE_ARM::ArmFSMState::PASSIVE);
|
||||
arm.sendRecvThread->shutdown();
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue