AP_Motors: use the right constrain() function