control_allocator: Added linearization feature for 4 servo swash plates to prevent binding

control_allocator: Added linearization feature for 4 servo swash plates to prevent binding #16637