A multiple-input multiple-output (MIMO) computer control system in a heavy equipment machine is in communication with multiple sensors in order to measure deviations from a path to be followed. Sensor corrections are applied to return the heavy equipment machine to a path to be followed or to restrain the machine from deviating from the path to be followed. Sensor corrections affect a controlled variable, such as cross-slope. Sensor corrections may account for false positives and false negatives. Sensor corrections are applied to the heavy equipment machine using a gain matrix (G). The multiple vectors of gain values comprising the gain matrix (G) are utilized by the MIMO computer control system to simultaneously and proportionally actuate each drive leg of the machine to obtain a desired grade including a compensated slope and/or elevation.