Look at moveit launch files and stuff.