- Merge with dual arm branch (retaining position control), bring urdfs/ moveit config in line with master.