Maze / DisplayPos.m
nevermore-kang's picture
7778f78f9a2f9efc54d23756d323b1dfddf010958ca0c10cdc52ca1b2329e6fe
c1049d6 verified
raw
history blame
514 Bytes
function out = DisplayPos(obj)
pos = getJointAndFingerPos(obj);
out = ['End Effector Position - X: ' sprintf('%.2f', obj.EndEffectorPose(1)) ...
', Y: ' sprintf('%.2f', obj.EndEffectorPose(2)) ...
', Z: ' sprintf('%.2f', obj.EndEffectorPose(3)) ...
'. Twist Angle (in radians): ' sprintf('%.2f', pos(7)) ...
', Finger 1 Strength: ' sprintf('%.2f', pos(8)) ...
', Finger 2 Strength: ' sprintf('%.2f', pos(9)) ...
', Finger 3 Strength: ' sprintf('%.2f', pos(10)) '.'];
end