set joint limits, forward kinematics arrangements
added angle scale and debugging