equations for head
deleted unused implementations
reimplementation of Legs' IK
remove
cleaned imports