void liftLeg() {
Generic6DofConstraint dofConstraint = (Generic6DofConstraint) joints[JointType.JOINT_RIGHT_KNEE
.ordinal()];
dofConstraint.buildJacobian();
float angle = dofConstraint.getAngle(1);
dofConstraint.testAngularLimitMotor(1);
// RotationalLimitMotor lim = dofConstraint.getRotationalLimitMotor(1);
TranslationalLimitMotor translim = dofConstraint
.getTranslationalLimitMotor();
//dofConstraint.
// translim.