fix add matrixToTuple function
Merge pull request #6 from damien-petit/addCameraOpPoint

fix missing matrixToTuple function for hrp2_10 close #5