Functions | |
| def | cam_rotation_matrix () |
| def | np_mat_to_str (m) |
| def | space_to_str (space) |
| def | transform_to_str (result) |
Variables | |
| string | chainName = "Head" |
| current = proxy.getPosition(chainName, space, False) | |
| currentSensor = proxy.getPosition(chainName, space, True) | |
| DCM = apply(transformations.euler_matrix,rpy) | |
| e = np.linalg.norm(DCM - m) | |
| string | frame1 = 'Torso_link' |
| string | frame2 = 'CameraTop_frame' |
| string | ip = "ra.local" |
| listener = TransformListener() | |
| m = transformations.quaternion_matrix(rot) | |
| int | port = 9559 |
| proxy = ALProxy("ALMotion", ip, port) | |
| rot | |
| rpy = currentSensor[3:] | |
| space = motion.SPACE_TORSO | |
| stamp = rospy.Time() | |
| T = np.matrix([tTCSensor[0:4],tTCSensor[4:8],tTCSensor[8:12],tTCSensor[12:]]) | |
| trans | |
| tTC = proxy.getTransform(chainName, space, False) | |
| tTCSensor = proxy.getTransform(chainName, space, True) | |
| tTH = proxy.getTransform(chainName, space, False) | |
| tTHSensor = proxy.getTransform(chainName, space, True) | |
| def test_cam_transform.cam_rotation_matrix | ( | ) |
Definition at line 47 of file test_cam_transform.py.
| def test_cam_transform.np_mat_to_str | ( | m | ) |
Definition at line 39 of file test_cam_transform.py.
| def test_cam_transform.space_to_str | ( | space | ) |
Definition at line 20 of file test_cam_transform.py.
| def test_cam_transform.transform_to_str | ( | result | ) |
Definition at line 28 of file test_cam_transform.py.
| string test_cam_transform.chainName = "Head" |
Definition at line 58 of file test_cam_transform.py.
Definition at line 60 of file test_cam_transform.py.
Definition at line 59 of file test_cam_transform.py.
| test_cam_transform.DCM = apply(transformations.euler_matrix,rpy) |
Definition at line 66 of file test_cam_transform.py.
Definition at line 102 of file test_cam_transform.py.
| string test_cam_transform.frame1 = 'Torso_link' |
Definition at line 86 of file test_cam_transform.py.
| string test_cam_transform.frame2 = 'CameraTop_frame' |
Definition at line 87 of file test_cam_transform.py.
| string test_cam_transform.ip = "ra.local" |
Definition at line 53 of file test_cam_transform.py.
| test_cam_transform.listener = TransformListener() |
Definition at line 52 of file test_cam_transform.py.
| test_cam_transform.m = transformations.quaternion_matrix(rot) |
Definition at line 96 of file test_cam_transform.py.
| int test_cam_transform.port = 9559 |
Definition at line 54 of file test_cam_transform.py.
| test_cam_transform.proxy = ALProxy("ALMotion", ip, port) |
Definition at line 55 of file test_cam_transform.py.
| test_cam_transform.rot |
Definition at line 90 of file test_cam_transform.py.
| test_cam_transform.rpy = currentSensor[3:] |
Definition at line 64 of file test_cam_transform.py.
| test_cam_transform.space = motion.SPACE_TORSO |
Definition at line 57 of file test_cam_transform.py.
| test_cam_transform.stamp = rospy.Time() |
Definition at line 85 of file test_cam_transform.py.
Definition at line 79 of file test_cam_transform.py.
| test_cam_transform.trans |
Definition at line 90 of file test_cam_transform.py.
Definition at line 75 of file test_cam_transform.py.
Definition at line 74 of file test_cam_transform.py.
Definition at line 69 of file test_cam_transform.py.
Definition at line 68 of file test_cam_transform.py.