add timestamp for cam_pose

communication/multi_vehicle_communication.sh

@@ -1,6 +1,6 @@
 #!/bin/bash
-iris_num=9
-typhoon_h480_num=0
+iris_num=0
+typhoon_h480_num=6
 solo_num=0
 plane_num=0
 rover_num=0

sensing/gimbal/gimbal_control.py

@@ -38,6 +38,7 @@ if __name__ == "__main__":
             response = gazeboLinkstate(vehicle_type+'_'+vehicle_id+'::cgo3_camera_link','ground_plane')
         except rospy.ServiceException, e:
             print "Gazebo model state service call failed: %s"%e
+        cam_pose.header.stamp = rospy.Time.now()
         cam_pose.pose = response.link_state.pose
         cam_pose_pub.publish(cam_pose)
         rate.sleep()