* P output in bodyKin
* geometricJacobian now able to handle frames.