I created a drone model that is cuboid and represented it as a floating joint with 6DOF using the moveit setup assistant. I cannot seem to get joint_state readings or any data that is able to transform the drone's position within moveit. I tried publishing to the tf2 topic the drone IMU data with modified parent/child link, but the drone still does not follow. Based on my understanding, the /move_group node processes sensor_msgs/JointState from rostopic /joint_state and updates the position states of joints in moveit. However, since the drone's joint has 6DOF, we are using sensor_msgs/MultiDofJointState to represent the joint state. 
Using moveit commander get_current_state() method, it reports "Joint values for monitored state are requested but the full state is not known" joint_state is empty while multi_dof_joint_state has the drone joint as expected. Attempting to do execute any planning results in Error. 
My guess is that the multi dof joint state of "drone" is not updating and hence, moveit rejects planning. Is there a way which (assuming I have IMU data) I can update the multi dof joint state of "drone" such that it shows the drone's position being updated with IMU data?
↧