Optimal Control Allocation on Over-Actuated Vehicles