Actuating And Sensing Joints Matlab