Simple Body Model
* parameter vector of joint angles and angular velocities = f