Added feedback for joint positions from actual robot to control gui
Prevented feedback to the joint_publisher for now