Moveit config and everything working on the real hardware