Methods and apparatus to implement nonlinear control of vehicles moved using multiple motors
Methods and apparatus to implement nonlinear control of vehicles moved using multiple motors, apparatus, systems and articles of manufacture are disclosed. An example apparatus includes a logic circuit configured to calculate virtual position control variables for a vehicle moved using multiple motors. The virtual position control variables calculated based on an application of a control law to position information of the vehicle. The control law is derived from a nonlinear model of movement of the vehicle. The logic circuit is configured further to calculate control inputs based on the virtual position control variables. The control inputs are to control the motors to navigate the vehicle along a designated path of movement.
1. An apparatus comprising a logic circuit configured to:
calculate virtual position control variables for a vehicle moved using multiple motors, the virtual position control variables calculated based on an application of a control law to position information of the vehicle, the control law derived from a nonlinear model of movement of the vehicle; and
calculate control inputs based on the virtual position control variables, the control inputs to control the motors to navigate the vehicle along a designated path of movement.
2. The apparatus of claim 1 , wherein the position information includes reference position information and measured position information, the logic circuit configured further to calculate reference orientation information based on the virtual position control variables, the reference orientation information and the reference position information corresponding to the designated path of movement for the vehicle.
3. The apparatus of claim 2 , wherein the logic circuit is configured further to calculate trigonometric values for measured orientation information, the measured orientation information including a measured yaw orientation, a measured pitch orientation, and a measured roll orientation, the reference orientation information calculated based on the measured yaw orientation.
4. The apparatus of claim 3 , wherein the trigonometric values for the measured yaw orientation are calculated prior to the trigonometric values for the measured pitch orientation and the measured roll orientation, the trigonometric values for the measured yaw orientation calculated in parallel with the virtual position control variables.
5. The apparatus of claim 3 , wherein the trigonometric values for at least one of the measured pitch orientation or the measured roll orientation are calculated in parallel with calculations of the reference orientation information.
6. The apparatus of claim 2 , wherein the logic circuit is configured further to calculate a total thrust for the vehicle based on the virtual position control variables, the total thrust corresponding to a first one of the control inputs.
7. The apparatus of claim 6 , wherein the reference orientation information includes a reference pitch orientation and a reference roll orientation, the reference roll orientation calculated using the total thrust.
8. The apparatus of claim 7 , wherein the reference pitch orientation is calculated before the reference roll orientation, the reference pitch orientation calculated in parallel with calculation of the total thrust.
9. The apparatus of claim 2 , wherein the logic circuit is configured further to calculate virtual orientation control variables for the vehicle based on an application of the control law to the reference orientation information and measured orientation information.
10. The apparatus of claim 9 , wherein the virtual position control variables are calculated using a first hardware architecture independent of a general-purpose processor, the virtual orientation control variables calculated via a second hardware architecture independent of the general-purpose processor, the first hardware architecture having a same architecture as the second hardware architecture.
11. The apparatus of claim 1 , wherein the logic circuit is configured further to generate pulse-width modulated inputs to control the motors of the vehicle based on the control inputs.
12. The apparatus of claim 1 , wherein the vehicle is an unmanned aerial vehicle and the designated path of movement is a trajectory for the unmanned aerial vehicle.
13. A non-transitory computer readable medium comprising instructions that, when executed, cause a machine to at least:
calculate virtual position control variables for a vehicle moved using multiple motors, the virtual position control variables calculated based on an application of a control law to position information of the vehicle, the control law derived from a nonlinear model of movement of the vehicle; and
calculate control inputs based on the virtual position control variables, the control inputs to control the motors to navigate the vehicle along a designated path of movement.
14. The non-transitory computer readable medium of claim 13 , wherein the position information includes reference position information and measured position information, the instructions to further cause the machine to calculate reference orientation information based on the virtual position control variables, the reference orientation information and the reference position information corresponding to the designated path of movement for the vehicle.
15. The non-transitory computer readable medium of claim 14 , wherein the instructions further cause the machine to calculate trigonometric values for measured orientation information, the measured orientation information including a measured yaw orientation, a measured pitch orientation, and a measured roll orientation, the reference orientation information calculated based on the measured yaw orientation.
16. The non-transitory computer readable medium of claim 15 , wherein the trigonometric values for the measured yaw orientation are calculated prior to the trigonometric values for the measured pitch orientation and the measured roll orientation, the trigonometric values for the measured yaw orientation calculated in parallel with the virtual position control variables.
17. A method comprising:
calculating virtual position control variables for a vehicle moved using multiple motors, the virtual position control variables calculated based on an application of a control law to position information of the vehicle, the control law derived from a nonlinear model of movement of the vehicle; and
calculating control inputs based on the virtual position control variables, the control inputs to control the motors to navigate the vehicle along a designated path of movement.
18. The method of claim 17 , wherein the position information includes reference position information and measured position information, the method further including calculating reference orientation information based on the virtual position control variables, the reference orientation information and the reference position information corresponding to the designated path of movement for the vehicle.
19. The method of claim 18 , further including calculating trigonometric values for measured orientation information, the measured orientation information including a measured yaw orientation, a measured pitch orientation, and a measured roll orientation, the reference orientation information calculated based on the measured yaw orientation.
20. The method of claim 19 , wherein the trigonometric values for the measured yaw orientation are calculated prior to the trigonometric values for the measured pitch orientation and the measured roll orientation, the trigonometric values for the measured yaw orientation calculated in parallel with the virtual position control variables.
21. The method of claim 18 , further including calculating a total thrust for the vehicle based on the virtual position control variables, the total thrust corresponding to a first one of the control inputs.
22. The method of claim 18 , further including calculating virtual orientation control variables for the vehicle based on an application of the control law to the reference orientation information and measured orientation information.