Add inverse kinematics example with implementations by Sam Buss.
Uses Kuka IIWA model description and 4 methods: Selectively Damped Least Squares,Damped Least Squares, Jacobi Transpose, Jacobi Pseudo Inverse Tweak some PD values in Inverse Dynamics example and Robot example.
This commit is contained in:
@@ -171,10 +171,10 @@ protected:
|
||||
|
||||
b3JointControlSetDesiredPosition(commandHandle, qIndex, targetPos);
|
||||
b3JointControlSetDesiredVelocity(commandHandle,uIndex,0);
|
||||
b3JointControlSetKp(commandHandle, qIndex, 0.01);
|
||||
b3JointControlSetKd(commandHandle, uIndex, 0.1);
|
||||
b3JointControlSetKp(commandHandle, qIndex, 0.2);
|
||||
b3JointControlSetKd(commandHandle, uIndex, 1.);
|
||||
|
||||
b3JointControlSetMaximumForce(commandHandle,uIndex,1000);
|
||||
b3JointControlSetMaximumForce(commandHandle,uIndex,5000);
|
||||
}
|
||||
}
|
||||
virtual void physicsDebugDraw(int debugFlags)
|
||||
|
||||
Reference in New Issue
Block a user