An aerial vehicle, comprising: one or more motors, one or more sensors, and a flight sub-system. The one or more sensors configured to detect data. The flight sub-system includes an attitude controller module; a rate controller module; and a compensator module. The compensator module is configured to: determine a maximum RPM of the one or more motors or a maximum torque of the one or more motors; receive a torque vector from the rate controller module; determine a rotational speed of the one or more motors to generate a desired flight orientation based upon the torque vector; and consider sensor data from the one or more sensors to adjust the rotational speed of the one or more motors.