Functions | |
def | mat2pose |
def | tf2mat |
Variables | |
int | angle = 0 |
list | force_sensable = quat_mat[0:3, 0:3] |
tuple | force_world = (w_T_6[0:3,0:3] * np.matrix([-2., 0, 0]).T) |
tuple | listener = tf.TransformListener() |
tuple | pos = np.matrix(tr.translation_from_matrix(tip_world)) |
tuple | qm = np.matrix(tr.quaternion_matrix(tr.quaternion_from_euler(0, math.pi, 0))) |
tuple | quat_mat = np.matrix(tr.quaternion_matrix(rot)) |
tuple | r = rospy.Rate(100) |
tip_6 = tm*qm | |
tip_world = w_T_6*tip_6 | |
tuple | tm = np.matrix(tr.translation_matrix([-.134, 0, 0])) |
tuple | w_T_6 = tf2mat(listener.lookupTransform('/world', '/omni1_link6', rospy.Time(0))) |
well_center = None | |
tuple | wpub = rospy.Publisher('force_feedback', Wrench) |
tuple | wr = Wrench() |
def push_away.mat2pose | ( | m | ) |
Definition at line 18 of file push_away.py.
def push_away.tf2mat | ( | tf_trans | ) |
Definition at line 14 of file push_away.py.
tuple push_away::angle = 0 |
Definition at line 41 of file push_away.py.
list push_away::force_sensable = quat_mat[0:3, 0:3] |
Definition at line 53 of file push_away.py.
tuple push_away::force_world = (w_T_6[0:3,0:3] * np.matrix([-2., 0, 0]).T) |
Definition at line 50 of file push_away.py.
tuple push_away::listener = tf.TransformListener() |
Definition at line 35 of file push_away.py.
tuple push_away::pos = np.matrix(tr.translation_from_matrix(tip_world)) |
Definition at line 48 of file push_away.py.
tuple push_away::qm = np.matrix(tr.quaternion_matrix(tr.quaternion_from_euler(0, math.pi, 0))) |
Definition at line 44 of file push_away.py.
tuple push_away::quat_mat = np.matrix(tr.quaternion_matrix(rot)) |
Definition at line 52 of file push_away.py.
tuple push_away::r = rospy.Rate(100) |
Definition at line 33 of file push_away.py.
Definition at line 46 of file push_away.py.
Definition at line 47 of file push_away.py.
tuple push_away::tm = np.matrix(tr.translation_matrix([-.134, 0, 0])) |
Definition at line 45 of file push_away.py.
tuple push_away::w_T_6 = tf2mat(listener.lookupTransform('/world', '/omni1_link6', rospy.Time(0))) |
Definition at line 43 of file push_away.py.
Definition at line 40 of file push_away.py.
tuple push_away::wpub = rospy.Publisher('force_feedback', Wrench) |
Definition at line 32 of file push_away.py.
tuple push_away::wr = Wrench() |
Definition at line 55 of file push_away.py.