Cap chasis speed
Added MSP motors configuration