Mission Control

Mission Control

Task Specification

TaskHow to triggerWhat happens when triggeredNode that handles thisMission Control Assigned to/Complete?Node Assigned to/Complete?
Request RGB dataSend std_msgs::Empty to topic /robot/request_rgbPublish latest RGB data as sensor_msgs::Image to topic /mission_ctrl/requested_rgborp_src_interface
  •  Andrei

Adam COMPLETE

Request depth dataSend std_msgs::Empty to topic /robot/request_depthPublish latest depth data as sensor_msgs::PointCloud2 to topic /mission_ctrl/requested_depthorp_src_interface
  •  Andrei

Adam COMPLETE

      
Display joint-plan interactive marker

Send std_msgs::String to topic /mission_ctrl/show_joint_marker

The message string is the joint name to show the marker on.

Hide other joint-plan interactive markers, show 6-DOF interactive marker for the specified joint, starting at the joint's current positionshould be called JointPlanMarkerServer
  •  
Dorothy
  •  
Add joint-plan waypoint

Call service of type comm_comm::AddWaypoint to topic /mission_ctrl/add_joint_waypoint

request.time = delta-t (from start of task) when to reach this waypoint

response.pose = current pose of interactive marker

1. Set service response to current position of joint-plan interactive marker

2. Update joint-plan path

JointPlanMarkerServer
  •  
Dorothy
  •  
Update joint-plan pathSend comm_comm::Waypoints list of joint poses to topic /mission_ctrl/joint_waypoints

Publish markers at each waypoint (small spheres or similar)

Publish marker to show trajectory (spline, straight-line, etc.) between waypoints

MissionControlGUI
  •  
Marcelino
  •  
      
Display locomotion-plan interactive marker

Send std_msgs::Empty to topic /mission_ctrl/show_locomotion_marker

Hide other locomotion-plan interactive markers, show 3-DOF (x/y movement, rotation about z) interactive marker for the robot's center of pressure position, starting at the current center of pressure.

shouuld be called

LocomotionPlanMarkerServer

  •  
Walt?
  •  
Add locomotion-plan waypoint

Call service of type comm_comm::AddWaypoint at name /mission_ctrl/add_locomotion_waypoint

request.time = delta-t (from start of task) when to reach this waypoint

response.pose = current pose of interactive marker

1. Set service response to current position of locomotion-plan interactive marker

2. Update locomotion path

LocomotionPlanMarkerServer
  •  
Walt?
  •  
Update locomotion pathSend comm_comm::Waypoints list of joint poses to topic /mission_ctrl/locomotion_waypoints

Publish markers at each waypoint (small spheres or similar)

Publish marker to show trajectory (spline, straight-line, etc.) between waypoints

Show footstep locations

LocomotionPlanMarkerServer
  •  
Walt
  •  
      
Display turn-in-place interactive markerSend std_msgs::Empty to topic /mission_ctrl/show_turn_in_place_markerHide other turn-in-place interactive markers, show 1-DOF (rotation about Z) interactive marker for the robot's heading, starting at the robot's current heading.InPlaceRotationPlanMarkerServer
  •  
  •  
Set turn-in-place rotation

Call service of type comm_comm::SetInPlaceRotation at name /mission_ctrl/set_in_place_rotation

request = empty (no timestamp, it will take as long as it takes)

response.heading = current heading (rotation) of interactive marker

Set service response to current z-rotation of the turn-in-place interactive markerInPlaceRotationPlanMarkerServer
  •  
  •  
      
Set configuration state publisher rate

Call service of type std_msgs::Float32 at name /robot/joint_state_publisher/set_publish_rate.

Value =The length of time between each configuration state publication

 Set publishing node's internal loop rateGazeboJointStatePublisher
  •  
  •  
      
Send prioritized task list to SRLib for execution

1. Send all locomotion tasks in message of type std_msgs::Float64MultiArray to topic /simulator/locomotion_tasks

2. Send all joint path tasks in message of type std_msgs::Float64MultiArray to topic /simulator/joint_tasks

1. Execute locomotion tasks in simulation

2. Execute joint path tasks in simulation

MissionControlGUI
  •  
Donghyun?
  •  
Send prioritized task list to Gazebo for execution

1. Send all locomotion tasks in message of type std_msgs::Float64MultiArray to topic /robot/locomotion_tasks

2. Send all joint path tasks in message of type std_msgs::Float64MultiArray to topic /robot/joint_tasks

1. Execute locomotion tasks

2. Execute joint path tasks

MissionControlGUI
  •  
Donghyun?
  •