Add transform before grabPositionHandL with 3 rotation for testing inverse kinematics
Change computeErrorVector function addinf errors from target to grab in the last Joint frame
Now go home is activated to avoid singularity matrix