Control of vehicle movement by application of geometric algebra and state and error estimation
A method and system for controlling movement of a vehicle. Movement, orientation, and position data of the vehicle is collected. A model of kinematics of the vehicle and its environment is created and a Theory of World model is produced and updated. The model includes geometric algebra multivectors. Errors and noise are stored as geometrically meaningful first-class objects within the multivectors. Geometric algebra operations are used to manipulate the model during operation. Error and noise data are propagated and manipulated using geometric algebra operations to reflect measurement and processing errors or noise. The models are used in generation of control data with a primary intent of ensuring stability. Operations such as intersections are used to compare position, orientation, and movement of the vehicle against position, orientation, and movement of objects in its environment. System tasks include, but are not limited to, kinematics, inverse kinematics, collision avoidance, and dynamics.
1. A method of controlling a vehicle having a chassis, a plurality of sensors, a propulsion system, and a processor, the method comprising:
receiving sensor-based vehicle state data from the plurality of sensors, the sensor-based vehicle state data having embedded information;
determining dynamic parameters of the vehicle according to the sensor-based vehicle state data;
combining the sensor-based vehicle state data in a non-optimized form into a unified spatial model representation of the vehicle and its surrounding environment by mapping the dynamic parameters into a single geometric algebraic space via geometric multivectors;
optimizing select portions of the sensor-based vehicle state data by evaluating embedded information of the select portions of the sensor-based vehicle state data as the embedded information of the select portions of the sensor-based vehicle state data is required;
calculating a movement control decision based on the unified spatial model;
generating a movement control instruction signal based on the movement control decision; and
controlling movement of the vehicle by sending the movement control instruction signal to the propulsion system such that the propulsion system effects the movement control decision.
2. The method of claim 1 , the plurality of sensors including an inertial measurement unit (IMU) configured to generate vehicle inertia data, the sensor-based vehicle state data including the vehicle inertia data.
3. The method of claim 1 , the plurality of sensors including a proximity sensor configured to generate object proximity data, the sensor-based vehicle state data including the object proximity data.
4. The method of claim 1 , the plurality of sensors including a camera configured to collect optical data near the vehicle, the sensor-based vehicle state data including the optical data.
5. The method of claim 1 , the vehicle further comprising an optical flow system configured to generate optical flow data, the method further comprising the step of combining the optical flow data in a non-optimized form into the unified spatial model representation of the vehicle and its surrounding environment.
6. The method of claim 1 , further comprising the step of maintaining a fixed world reference frame, a dynamic vehicle reference frame, and multi-dimensional flight parameters.
7. The method of claim 1 , wherein the optimizing step includes:
determining at least one of errors and noise associated with the select portions of the sensor-based vehicle state data; and
assigning confidence levels to the dynamic parameters based on the at least one of errors and noise associated with the select portions of the sensor-based vehicle state data.
8. The method of claim 1 , further comprising the step of parameterizing the sensor-based vehicle state data over time.
9. The method of claim 1 , wherein each of the plurality of sensors is associated with a sensor channel, the method further comprising the step of generating a frequency-based confidence profile for each sensor channel via a continuously updated frequency domain transfer.
10. The method of claim 1 , further comprising the steps of:
receiving vehicle control data corresponding to inputs of an operator, the vehicle control data including embedded information;
determining additional dynamic parameters of the vehicle according to the vehicle control data;
combining the vehicle control data in a non-optimized form into the unified spatial model representation of the vehicle and its surrounding environment by mapping the additional dynamic parameters into the single geometric algebraic space via geometric multivectors such that the operator inputs are incorporated into the unified spatial model as another form of sensor input; and
optimizing select portions of the vehicle control data by evaluating embedded information of the select portions of the vehicle control data as the embedded information of the select portions of the vehicle control data is required.
11. The method of claim 10 , wherein the vehicle control data optimizing step includes:
determining at least one of errors and noise associated with the select portions of the vehicle control data; and
assigning confidence levels to the additional dynamic parameters based on the at least one of errors and noise associated with the select portions of the vehicle control data.
12. The method of claim 10 , wherein the operator is a human.
13. The method of claim 10 , wherein the operator is an autonomous or semi-autonomous computational system.
14. A vehicle comprising:
a propulsion system for propelling the vehicle;
a plurality of sensors configured to generate sensor-based vehicle state data; and
a processor configured to:
determine dynamic parameters of the vehicle according to the sensor-based vehicle state data;
combine the sensor-based vehicle state data in a non-optimized form into a unified spatial model representation of the vehicle and its surrounding environment by mapping the dynamic parameters into a single geometric algebraic space via geometric multivectors;
optimize select portions of the sensor-based vehicle state data by evaluating embedded information of the select portions of the sensor-based vehicle state data as the select portions of the embedded information is required;
calculate a movement control decision based on the unified spatial model;
generate a movement control instruction signal based on the movement control decision; and
control movement of the vehicle by sending the movement control instruction signal to the propulsion system such that the propulsion system effects the movement control decision.
15. The vehicle of claim 14 , the plurality of sensors including an inertial measurement unit (IMU) configured to generate vehicle inertia data, the sensor-based vehicle state data including the vehicle inertia data.
16. The vehicle of claim 14 , the plurality of sensors including a proximity sensor configured to generate object proximity data, the sensor-based vehicle state data including the object proximity data.
17. The vehicle of claim 14 , the plurality of sensors including a camera configured to collect optical data near the vehicle, the sensor-based vehicle state data including the optical data.
18. The vehicle of claim 14 , further comprising an optical flow system configured to generate optical flow data, the processor being further configured to combine the optical flow data in a non-optimized form into the unified spatial model representation of the vehicle and its surrounding environment.
19. The vehicle of claim 14 , wherein the processor is configured to maintain a fixed world reference frame, a dynamic vehicle reference frame, and multi-dimensional flight parameters.
20. The vehicle of claim 14 , wherein the processor is further configured to:
determine at least one of errors and noise associated with the select portions of the sensor-based vehicle state data; and
assign confidence levels to the dynamic parameters based on the at least one of errors and noise associated with the select portions of the sensor-based vehicle state data.
21. The vehicle of claim 14 , wherein the processor is further configured to parameterize the sensor-based vehicle state data over time.
22. The vehicle of claim 14 , wherein the vehicle is one of an on-the-ground, in-air, on-water, underwater, under-ground, and in-space vehicle.
23. The vehicle of claim 14 , wherein the processor is further configured to:
receive vehicle control data corresponding to operator inputs, the vehicle control data including embedded information;
determine additional dynamic parameters of the vehicle according to the vehicle control data;
combine the vehicle control data in a non-optimized form into the unified spatial model representation of the vehicle and its surrounding environment by mapping the additional dynamic parameters into the single geometric algebraic space via geometric multivectors such that the operator inputs are incorporated into the unified spatial model as another form of sensor input; and
optimize select portions of the vehicle control data by evaluating embedded information of the select portions of the vehicle control data as the embedded information of the select portions of the vehicle control data is required.
24. The vehicle of claim 23 , wherein the processor is further configured to: determine at least one of errors and noise associated with the select portions of the vehicle control data; and
assign confidence levels to the additional dynamic parameters based on the at least one of errors and noise associated with the select portions of the vehicle control data.
25. A vehicle comprising:
a propulsion system for propelling the vehicle;
a plurality of sensors configured to generate sensor-based vehicle state data, the plurality of sensors including:
an inertial measurement unit (IMU) configured to generate vehicle inertia data,
a proximity sensor configured to generate object proximity data, and
a camera configured to collect optical data near the vehicle,
the sensor-based vehicle state data including the vehicle inertia data, the object proximity data, and the optical data;
an optical flow system configured to generate optical flow data;
a transceiver configured to receive vehicle control data, the vehicle control data corresponding to operator inputs, the sensor-based vehicle state data, the vehicle control data, and the optical flow data having embedded information; and
a processor configured to:
receive the vehicle control data via the transceiver;
determine dynamic parameters of the vehicle according to the sensor-based vehicle state data, the vehicle control data, and the optical flow data over time;
combine the sensor-based vehicle state data, the vehicle control data, and the optical flow data in a non-optimized form into a unified spatial model representation of the vehicle and its surrounding environment by mapping the dynamic parameters into a single geometric algebraic space via geometric multivectors;
optimize select portions of the sensor-based vehicle state data, vehicle control data, and optical flow data by evaluating embedded information of the select portions of the sensor-based vehicle state data, vehicle control data, and optical flow data as the embedded information of the select portions of the sensor-based vehicle state data, vehicle control data, and optical flow data is required, the optimization including:
determining at least one of errors and noise associated with the select portions of the sensor-based vehicle state data, vehicle control data, and optical flow data; and
assigning confidence levels to the dynamic parameters based on the at least one of errors and noise associated with the select portions of the sensor-based vehicle state data, vehicle control data, and optical flow data;
maintain a fixed world reference frame, a dynamic vehicle reference frame, and a multi-dimensional flight parameters via the dynamic parameters;
calculate a movement control decision based on the unified spatial model;
generate a movement control instruction signal based on the movement control decision; and
control movement of the vehicle by sending the movement control instruction signal to the propulsion system such that the propulsion system effects the movement control decision.