rewritten matlab scripts for kinematic chain visualization

Now the roll-pitch-yaw matrix for the URDF file is one of the ouputs
The inputs are separated according to the control boards:

Torso
Shoulders
Left Arm
Right Arm
Neck-Eyes