Mobility device control system

Patent metadata

Field	Value
Publication number	US-10220843-B2
Application number	US-201715441190-A
Country	US
Kind code	B2
Filing date	Feb 23, 2017
Priority date	Feb 23, 2016
Publication date	Mar 5, 2019
Grant date	Mar 5, 2019

Abstract

A mobility device that can accommodate speed sensitive steering, adaptive speed control, a wide weight range of users, an abrupt change in weight, traction control, active stabilization that can affect the acceleration range of the mobility device and minimize back falls, and enhanced redundancy that can affect the reliability and safety of the mobility device.

First claim

What is claimed is:

1. A mobility device control system comprising:
at least one user control device receiving desired actions for the mobility device;
at least one power base controller operably coupled with the at least one user control device, the at least one power base controller receiving the desired actions from the at least one user control device, the at least one power base controller including at least two processors, the at least two processors each including at least one controller processing task, the at least one controller processing task receiving sensor data and motor data associated with sensors, wheels, and motors operably coupled with the mobility device; and
at least one inertial measurement unit (IMU) operably coupled with the at least one power base controller, the at least one IMU producing an inertial estimate, the inertial estimate based at least on filtering data from the at least one IMU, the at least one IMU including a rate sensor and an accelerometer, the filtering including
(a) receiving and filtering a gravity vector of the mobility device from the accelerometer, the filtering based at least on a gravity rate,
(b) receiving and filtering a body rate vector of the mobility device from the rate sensor, the filtering based at least on a gravity rate error and a projected body rate error,
(c) receiving a differential wheel speed representing the difference in speed of each of the at least two wheels;
(d) estimating a projected gravity rate based at least on the filtered gravity vector and the filtered body rate vector;
(e) computing the projected body rate error based at least on the projected gravity rate and the differential wheel speed;
(f) computing a pitch and a roll based at least on the filtered measured body rate and the filtered gravity vector; and
(g) repeating steps (a)-(f) using the computed projected body rate error;

the inertial estimate used to compute a pitch and a roll of the mobility device,
wherein the at least two processors compute values based at least on the desired actions, the sensor data, the motor data, the pitch and the roll of the mobility device, the values being provided to the wheels to control the motion of the mobility device.

2. The mobility device as in claim 1 wherein the controller processing task comprises:
at least one voting/commit processor resolving which of the at least one value to use to compute a wheel command.

3. The mobility device as in claim 2 wherein the controller processing task comprises:
at least one adaptive speed control processor computing at least one wheel command based at least on sensor data, the at least one wheel command being automatically modified depending on obstacles encountered in the path of the mobility device.

4. The mobility device as in claim 2 wherein the controller processing task comprises:
at least one speed processor computing at least one wheel command based at least on parameters adjusted according to at least one user preference.

5. The mobility device as in claim 1 wherein the controller processing task comprises:
at least one traction control processor automatically adjusting the at least one wheel command based at least on a comparison between inertial and linear accelerations of the mobility device.

6. The mobility device as in claim 1 wherein the controller processing task comprises:
at least one weight processor automatically estimating the load on the mobile device, determining the center of gravity for the mobile device and the load, computing gains based at least on the load and the center of gravity, and computing the at least one wheel command based at least on the gains.

7. The mobility device as in claim 1 wherein the controller processing task comprises:
an active stabilization processor automatically computing at least one wheel command to decelerate forward motion and accelerate backward motion when the mobility device encounters an obstacle, the active stabilization processor controlling a rearwards pitch rate of the mobility device.

8. The mobility device as in claim 1 wherein the controller processing task comprises:
a center of gravity fit generating calibration coefficients establishing the center of gravity of the mobility device based on a pitch angle of the mobility device required to maintain balance, the pitch angle measured when the mobility device is in pre-selected positions.

9. A method for controlling a mobility device, the mobility device including at least one user control device, at least one a power base controller having at least two processors, the at least two processors each having at least one controller processing task, at least one sensor, at least two wheels controlled by at least two motors, and at least one inertial measurement unity (IMU) having an IMU accelerometer and an IMU rate sensor, the method comprising:
receiving desired actions for the mobility device;
receiving, by the at least one controller processing task, sensor data from the at least one sensor, and motor data from the at least one motor;
filtering data from the at least one IMU, the at least one IMU including a rate sensor and an accelerometer, the filtering including
(a) receiving and filtering a gravity vector of the mobility device from the accelerometer, the filtering based at least on a gravity rate,
(b) receiving and filtering a body rate vector of the mobility device from the rate sensor, the filtering based at least on a gravity rate error and a projected body rate error,
(c) receiving a differential wheel speed representing the difference in speed of each of the at least two wheels;
(d) estimating a projected gravity rate based at least on the filtered gravity vector and the filtered body rate vector;
(e) computing the projected body rate error based at least on the projected gravity rate and the differential wheel speed;
(f) computing a pitch and a roll based at least on the filtered measured body rate and the filtered gravity vector; and
(g) repeating steps (a)-(f) using the computed projected body rate error;

computing, by each of the at least one controller processing tasks, at least one value based at least on the desired actions, the sensor data, the motor data, the pitch, and the roll; and
applying the at least one value to at least one of the at least two wheels to control the mobility device.

10. The method as in claim 9 further comprising:
resolving which of the at least one value, from the at least one controller processing task, to use to control the mobility device.

11. The method as in claim 9 further comprising:
automatically modifying the at least one value depending on obstacles encountered in the path of the mobility device.

12. The method as in claim 9 further comprising:
computing the at least one value based at least on parameters adjusted according to at least one user preference.

13. The method as in claim 9 further comprising:
automatically adjusting the at least one value based at least on a comparison between inertial and linear accelerations of the mobility device.

14. The method as in claim 9 further comprising:
automatically estimating the weight of a load on the mobile device;
determining the center of gravity for the mobile device and the load;
computing gains based at least on the load and the center of gravity; and
computing the at least value based at least on the gains.

15. The method as in claim 9 further comprising:
automatically computing at least one value to decelerate forward motion of the mobility device and accelerate backward motion of the mobility device when the m

Assignees

• Deka Products Lp

Inventors

• Coulter Stewart M
• Gray Brian G
• Van Der Merwe Dirk A
• Dastous Susan D
• Pawlowski Daniel F

Classifications

• B60W2554/00

  Input parameters relating to objects · CPC title

• B60L2240/12

  Speed · CPC title

• B60L2260/44

  by parameter estimation · CPC title

• B60L3/0015 Primary

  Prevention of collisions · CPC title

• B60L2240/26

  Vehicle weight · CPC title