Added pr2_motor_diagnostic_tool