rospy.init_node("camera_test", anonymous = True)
pub = rospy.Publisher("/rviz/camera_placement", CameraPlacement)
rate_float = 10
rate = rospy.Rate(rate_float)
rospy.Rate(2).sleep()
for i in range(3):
t = rospy.get_time()
cp = CameraPlacement()
cp.attached_frame = "r_forearm_cam_frame"
p = Point(0,0, 0)
cp.eye.point = p
cp.eye.header.frame_id = "r_forearm_cam_frame"
f = Point(1, 0, 0)
cp.focus.point = f
cp.focus.header.frame_id = "r_forearm_cam_frame"
up = Vector3(0,0,1)
cp.up.vector = up
cp.up.header.frame_id = "r_forearm_cam_frame"
cp.time_from_start = rospy.Duration(1)
rospy.init_node("camera_test", anonymous = True)
pub = rospy.Publisher("/rviz/camera_placement", CameraPlacement)
rate_float = 10
rate = rospy.Rate(rate_float)
rospy.Rate(1).sleep()
for i in range(3):
t = rospy.get_time()
cp = CameraPlacement()
cp.attached_frame = "head_mount_kinect_rgb_link"
p = Point(0,0, 0)
cp.eye.point = p
cp.eye.header.frame_id = "head_mount_kinect_rgb_link"
f = Point(1, 0, 0)
cp.focus.point = f
cp.focus.header.frame_id = "head_mount_kinect_rgb_link"
up = Vector3(0,0,1)
cp.up.vector = up
cp.up.header.frame_id = "head_mount_kinect_rgb_link"
cp.time_from_start = rospy.Duration(1)
print "Publishing a message!"
rospy.init_node("camera_test", anonymous = True)
pub = rospy.Publisher("/rviz/camera_placement", CameraPlacement)
rate_float = 10
rate = rospy.Rate(rate_float)
rospy.Rate(2).sleep()
for i in range(3):
t = rospy.get_time()
cp = CameraPlacement()
cp.attached_frame = "narrow_stereo_link"
p = Point(0,0, 0)
cp.eye.point = p
cp.eye.header.frame_id = "narrow_stereo_link"
f = Point(1, 0, 0)
cp.focus.point = f
cp.focus.header.frame_id = "narrow_stereo_link"
up = Vector3(0,0,1)
cp.up.vector = up
cp.up.header.frame_id = "narrow_stereo_link"
cp.time_from_start = rospy.Duration(1)
print "Publishing a message!"
rospy.init_node("camera_test", anonymous = True)
pub = rospy.Publisher("/rviz/camera_placement", CameraPlacement)
rate_float = 10
rate = rospy.Rate(rate_float)
rospy.Rate(2).sleep()
for i in range(3):
t = rospy.get_time()
cp = CameraPlacement()
cp.attached_frame = "base_link"
p = Point(2,2, 2)
cp.eye.point = p
cp.eye.header.frame_id = "base_link"
f = Point(1, 0, 0)
cp.focus.point = f
cp.focus.header.frame_id = "torso_lift_link"
up = Vector3(0,0,1)
cp.up.vector = up
cp.up.header.frame_id = "base_link"
cp.time_from_start = rospy.Duration(1)
print "Publishing a message!"
rospy.init_node("camera_test", anonymous = True)
pub = rospy.Publisher("/rviz/camera_placement", CameraPlacement)
rate_float = 10
rate = rospy.Rate(rate_float)
rospy.Rate(2).sleep()
for i in range(2):
t = rospy.get_time()
cp = CameraPlacement()
cp.attached_frame = "head_pan_link"
p = Point(-3, -0.5, 1.3)
cp.eye.point = p
cp.eye.header.frame_id = "head_pan_link"
f = Point(0.6, -0.25, 0)
cp.focus.point = f
cp.focus.header.frame_id = "head_pan_link"
up = Vector3(0,0,1)
cp.up.vector = up
cp.up.header.frame_id = "base_link"
cp.time_from_start = rospy.Duration(1)
print "Publishing a message!"
