Accessing position coordinates in gazebo_msgs/ModelStates
I have been trying to access xyz coordinates of pose position of each of my objects in gazebo. I have three models in gazebo world- ground, quad copter & square box. The structure of the modelSates is string model_name geometry_msgs/Pose pose geometry_msgs/Point position float64 x float64 y float64 z geometry_msgs/Quaternion orientation float64 x float64 y float64 z float64 w geometry_msgs/Twist twist geometry_msgs/Vector3 linear float64 x float64 y float64 z geometry_msgs/Vector3 angular float64 x float64 y float64 z string reference_frame I am getting error in accessing the position xyz coordinate. The way I am doing is double p = ms->pose.position[1].x; where ms is the pointer to the ModelStates in the callback function.