bug fix in reshapeJacobian Mainrobotgen and testmainLBR