Implement inverse dynamics for the legs
Implement inverse dynamics for the legs