Remove old (and not working) inverse dynamics serial solver
Added support for CRBA (Mass Matrix) and coriolis/gravity torques, both floating base and fixed base