Ask Your Question
0

Change Start position of Quadrotor using moveit

asked 2015-08-04 06:11:14 -0500

p_mukherjee gravatar image

Hi everyone,

             I am trying to use moveit package for planning path of my quadrotor. I have been able to publish goal points for the quadrotor to move, however, as moveit takes initial position from joint space, the start position is always fixed to [0,0,0,0,0,0,1]. I want to know if its possible to change the start position.

P.N. - Since this a quadrotor, there's no end effector and hence I cannot use this snippet to change the start position.


robot_state::RobotState start_state(*group.getCurrentState()); geometry_msgs::Pose start_pose2; start_pose2.orientation.w = 1.0; start_pose2.position.x = 0.55; start_pose2.position.y = -0.05; start_pose2.position.z = 0.8; const robot_state::JointModelGroup *joint_model_group = start_state.getJointModelGroup(group.getName()); start_state.setFromIK(joint_model_group, start_pose2); group.setStartState(start_state);


Thanks in advance Poulastya

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
0

answered 2015-08-28 03:35:59 -0500

p_mukherjee gravatar image

I managed to create a workaround for this problem. While running moveit demo.launch file, I found in rqt graph that, /move_group goal can both publish to and subscribe from the move group node. I created a publisher which publishes to /move_group/goal and a subscriber which subscribed to /move_group/display_planned_path. After that I used these waypoints to move the hector quadrotor using the hector quadrotor's controller.

P.N - the joint space won't be updated, so you won't be able to see the quadrotor move in rviz, but it works fine in gazebo

edit flag offensive delete link more

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools

1 follower

Stats

Asked: 2015-08-04 06:11:14 -0500

Seen: 346 times

Last updated: Aug 28 '15