fix to Fix #459 for pr2 to work with MotionXYW