ES2702982T3 - Un sistema de control para controlar una disposición motriz para accionar de manera diferencial las ruedas izquierda y derecha de un vehículo motorizado - Google Patents
Un sistema de control para controlar una disposición motriz para accionar de manera diferencial las ruedas izquierda y derecha de un vehículo motorizado Download PDFInfo
- Publication number
- ES2702982T3 ES2702982T3 ES07766288T ES07766288T ES2702982T3 ES 2702982 T3 ES2702982 T3 ES 2702982T3 ES 07766288 T ES07766288 T ES 07766288T ES 07766288 T ES07766288 T ES 07766288T ES 2702982 T3 ES2702982 T3 ES 2702982T3
- Authority
- ES
- Spain
- Prior art keywords
- yaw rate
- rate signal
- signal
- value
- speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000012937 correction Methods 0.000 claims abstract description 18
- 230000004044 response Effects 0.000 claims abstract description 6
- 230000008859 change Effects 0.000 claims description 31
- 238000004364 calculation method Methods 0.000 claims description 28
- 238000012545 processing Methods 0.000 claims description 12
- 229920006395 saturated elastomer Polymers 0.000 claims description 5
- 230000003750 conditioning effect Effects 0.000 description 24
- 238000000034 method Methods 0.000 description 11
- 230000008569 process Effects 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 3
- JJLJMEJHUUYSSY-UHFFFAOYSA-L Copper hydroxide Chemical compound [OH-].[OH-].[Cu+2] JJLJMEJHUUYSSY-UHFFFAOYSA-L 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 241001503987 Clematis vitalba Species 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 238000004378 air conditioning Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000009024 positive feedback mechanism Effects 0.000 description 1
- 238000009987 spinning Methods 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
- B60L15/2036—Electric differentials, e.g. for supporting steering vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L50/00—Electric propulsion with power supplied within the vehicle
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G5/00—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs
- A61G5/04—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs motor-driven
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G5/00—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs
- A61G5/04—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs motor-driven
- A61G5/041—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs motor-driven having a specific drive-type
- A61G5/045—Rear wheel drive
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K17/00—Arrangement or mounting of transmissions in vehicles
- B60K17/04—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing
- B60K17/16—Arrangement or mounting of transmissions in vehicles characterised by arrangement, location, or kind of gearing of differential gearing
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K17/00—Arrangement or mounting of transmissions in vehicles
- B60K17/34—Arrangement or mounting of transmissions in vehicles for driving both front and rear wheels, e.g. four wheel drive vehicles
- B60K17/356—Arrangement or mounting of transmissions in vehicles for driving both front and rear wheels, e.g. four wheel drive vehicles having fluid or electric motor, for driving one or more wheels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K23/00—Arrangement or mounting of control devices for vehicle transmissions, or parts thereof, not otherwise provided for
- B60K23/04—Arrangement or mounting of control devices for vehicle transmissions, or parts thereof, not otherwise provided for for differential gearing
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/10—General characteristics of devices characterised by specific control means, e.g. for adjustment or steering
- A61G2203/14—Joysticks
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/30—General characteristics of devices characterised by sensor means
- A61G2203/42—General characteristics of devices characterised by sensor means for inclination
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K7/00—Disposition of motor in, or adjacent to, traction wheel
- B60K7/0007—Disposition of motor in, or adjacent to, traction wheel the motor being electric
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/80—Other vehicles not covered by groups B60Y2200/10 - B60Y2200/60
- B60Y2200/84—Wheelchairs
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/64—Electric machine technologies in electromobility
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Life Sciences & Earth Sciences (AREA)
- Power Engineering (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
Un sistema que comprende: una disposición motriz que comprende dos motores eléctricos accionados independientemente (39, 40) para accionar de manera diferente las ruedas izquierda y derecha de un vehículo motorizado: un sistema de control (20) para controlar la disposición motriz; caracterizado por que el sistema de control comprende: un lazo de control de retroalimentación de velocidad de guiñada que comprende: un comparador (30) para recibir una señal de velocidad de guiñada del sensor (8a) de un sensor de velocidad de guiñada, siendo la señal de velocidad de guiñada del sensor indicativa de una velocidad de guiñada real del vehículo y para recibir una señal de velocidad de guiñada de referencia generada por un dispositivo de entrada de usuario, siendo la señal de velocidad de guiñada de referencia indicativa de una velocidad de guiñada demandada por el usuario para el vehículo, el comparador dispuesto para emitir una señal de velocidad de guiñada de error basada en una diferencia entre la señal de velocidad de guiñada del sensor y la señal de velocidad de guiñada de referencia; un limitador variable (32) para limitar una señal de velocidad de guiñada de corrección a valores dentro de un límite variable, la señal de velocidad de guiñada de corrección para controlar la disposición motriz para reducir la señal de velocidad de guiñada de error; un compensador (31) entre el comparador (30) y el limitador variable para recibir como entrada la señal de velocidad de guiñada de error y generar en respuesta a la misma la señal de velocidad de guiñada de corrección; un calculador de límites para calcular continuamente el límite variable en función de una o más señales de entrada y/o generadas por el lazo de control.
Description
DESCRIPCIÓN
Un sistema de control para controlar una disposición motriz para accionar de manera diferencial las ruedas izquierda y derecha de un vehículo motorizado
La presente invención se refiere a un sistema de control para controlar una disposición motriz para accionar de manera diferencial las ruedas izquierda y derecha de un vehículo motorizado, en particular, pero no exclusivamente, una silla de ruedas con alimentación.
Una silla de ruedas con alimentación eléctrica tiene normalmente dos motores eléctricos accionados independientemente, uno para accionar una rueda izquierda de la silla de ruedas y el otro para accionar una rueda derecha de la silla de ruedas. La velocidad diferencial de estos motores controla la velocidad de avance y la velocidad de giro de la silla de ruedas.
Una silla de ruedas típica está provista de un dispositivo de entrada, generalmente un joystick de dos ejes, al cual un usuario aplica estímulos para generar señales de referencia de velocidad de avance y de velocidad de guiñada. Un módulo de control recibe las señales de referencia del dispositivo de entrada y procesa las señales para calcular las señales de referencia de velocidad del motor izquierdo y derecho que se comparan con las señales indicativas de las mediciones reales de las velocidades actuales del motor izquierdo y derecho. Las diferencias entre las señales de referencia de velocidad del motor y las señales de velocidad del motor reales se utilizan por un sistema de control de lazo cerrado para aplicar tensiones a los motores para accionar las ruedas para mantener la silla de ruedas a la velocidad y rumbo demandados por el usuario.
Un control de lazo cerrado de este tipo se logra generalmente mediante lo que se conoce como la técnica de compensación IR. La compensación IR es un método utilizado para compensar la caída en la velocidad de un motor debida a la caída de tensión en su resistencia de armadura (R) cuando la corriente (I) fluye en el devanado de armadura del motor. La compensación IR hace que el lazo de control de velocidad aumente la tensión del motor y la corriente del motor para estabilizar la velocidad del motor cuando aumenta la carga del motor. Si el término R se establece demasiado alto, el mecanismo de retroalimentación positiva inherente al método de compensación IR provoca un problema de control y el lazo de control se vuelve inestable.
Por ejemplo, a medida que se aplica carga al motor, el término IR sobrecompensado en el cálculo de retroalimentación de velocidad hace que el lazo de control de velocidad aumente la tensión del motor hasta un punto en que la velocidad y la corriente del motor se vean obligadas a aumentar. En consecuencia, el lazo de velocidad reacciona para aumentar aún más la tensión del motor, lo que aumenta aún más la velocidad y la corriente del motor. Este efecto descontrolado de la velocidad del motor provoca la inestabilidad de velocidad del lazo de velocidad cerrado del motor. Por lo tanto, no es posible compensar la resistencia total de la armadura del motor y esto conduce a un error en la señal de retroalimentación de velocidad que puede, bajo determinadas condiciones de accionamiento, afectar la capacidad de control de la silla de ruedas.
Hay varios problemas potenciales de control de la silla de ruedas que pueden resultar de anomalías en la compensación IR. Por ejemplo, al maniobrar a baja velocidad en espacios restringidos, si las cargas del motor de la silla de ruedas no se mantienen constantes, el usuario tendrá que hacer correcciones constantemente para mantener la silla de ruedas en el rumbo deseado variando el desplazamiento del joystick. Esto se debe que el error en la señal de retroalimentación de velocidad provocado por el término R bajo varía con la carga del motor y la única manera de mantener una velocidad constante es compensar este error variando la demanda de entrada. Esto dificulta las maniobras en espacios restringidos y abarrotados y, a menudo, provoca colisiones porque el usuario carece de un control a baja velocidad suficientemente preciso. Los ejemplos incluyen pasar por puertas estrechas, conducir por pasillos estrechos y atracar en una mesa. Estas maniobras son más difíciles cuando se conduce sobre superficies de alta fricción, como las alfombras.
Los problemas de control también pueden ocurrir cuando se conduce a altas velocidades de avance, porque cualquier carga asimétrica brusca de los motores derecho e izquierdo de la silla de ruedas tenderá a hacer que el motor con la carga decreciente se acelere y el motor con la carga creciente se desacelere, lo que da como resultado que la silla de ruedas se desvíe de su rumbo previsto.
Además, cuando se conduce una silla de ruedas a través de un peralte, la carga asimétrica de los motores derecho e izquierdo de la silla de ruedas hace que la silla de ruedas se desvíe hacia abajo del peralte a pesar de que el usuario demande conducir sobre él.
Además, cuando se conduce sobre obstáculos, la carga asimétrica de los motores de la silla de ruedas puede hacer que la silla de ruedas se desvíe bruscamente de la dirección de desplazamiento prevista.
El documento US 6.202.773 describe una silla de ruedas motorizada provista de un sensor de retroalimentación de velocidad de giro y con sensores de retroalimentación de movimiento de avance/retroceso, movimiento lateral
y aceleración de movimiento vertical que se integran en un sistema de servocontrol de la silla de ruedas de lazo cerrado para controlar de manera diferencial la velocidad de rotación de una pareja de ruedas motorizadas. Las formas de realización de la presente invención pretenden proporcionar un sistema mejorado que comprenda una disposición motriz que comprenda dos motores eléctricos accionados independientemente para accionar de manera diferencial los motores izquierdo y derecho de un vehículo motorizado y un sistema de control para controlar la disposición motriz.
De acuerdo con la presente invención, se proporciona un sistema según se define en la reivindicación 1.
Se describirán ahora las formas de realización de la invención a modo de ejemplo solamente con referencia a los dibujos adjuntos en los que:
La Figura 1 es un diagrama esquemático de una silla de ruedas motorizada;
La Figura 2 es un diagrama esquemático de un sistema de control para una silla de ruedas motorizada;
La Figura 3 es otro diagrama esquemático de un sistema de control para una silla de ruedas motorizada.
Con referencia a la Figura 1, la silla de ruedas alimentada eléctricamente 1 comprende un chasis 2, una rueda motriz trasera izquierda 3, una rueda motriz trasera derecha 4 y un par de ruedecillas delanteras 5. La silla de ruedas 1 también cuenta con dos motores eléctricos accionados independientemente (no mostrados en la Figura 1), es decir, un motor izquierdo para accionar la rueda trasera izquierda 3 y un motor derecho para accionar la rueda trasera derecha 4. Una batería (B) proporciona energía para la silla de ruedas 1.
Un módulo de entrada de control de usuario 6 que comprende un dispositivo de entrada 7, normalmente en la forma de un joystick, proporciona un medio mediante el cual un usuario (no mostrado) puede ingresar señales de demanda de velocidad de avance/retroceso y señales de demanda de velocidad angular de giro a la silla de ruedas. La velocidad angular de giro de la silla de ruedas (o velocidad de guiñada) es la velocidad de rotación de la silla de ruedas sobre su eje vertical (A). Las señales de demanda de velocidad de avance/retroceso y las señales de demanda de velocidad de guiñada de entrada de usuario indican la velocidad de avance y retroceso y la velocidad de guiñada respectivamente deseadas por el usuario para la silla de ruedas. Al manipular el dispositivo de entrada 7, un usuario puede hacer, por lo tanto, que la silla de ruedas se mueva hacia adelante o hacia atrás y gire a la izquierda o a la derecha.
Un módulo sensor de velocidad de guiñada 8 se instala en el chasis de la silla de ruedas 2 para medir la velocidad de guiñada real de la silla de ruedas 1 y para generar una señal indicativa de esta velocidad de guiñada real.
Un módulo de control 9, también instalado en el chasis 2, recibe señales de demanda de velocidad de avance/retroceso del usuario y señales de demanda de velocidad de guiñada del usuario desde el módulo de entrada 6 y señales de velocidad de guiñada real desde el módulo de sensor 8. El módulo de control 9 procesa las señales recibidas y utiliza las señales procesadas para controlar los motores derecho e izquierdo (no mostrados) de la silla de ruedas 1.
El módulo de control 9 compara la velocidad de guiñada demandada por el usuario con la señal de velocidad de guiñada real producida por el módulo sensor 8. La diferencia entre estas señales (señal de error) se envía a través de un lazo de control cerrado, que calcula una demanda de guiñada de corrección para reducir el error de rumbo de la silla de ruedas 1. Así, por ejemplo, el módulo de control 9 aumenta o disminuye la demanda de guiñada de los motores para mantener la silla de ruedas en su rumbo deseado.
Instalar un sensor de velocidad de guiñada al chasis de la silla de ruedas para medir la velocidad de guiñada de la silla de ruedas y utilizar la salida para corregir las desviaciones provocadas por las anomalías de la compensación IR puede mejorar la capacidad de control de la silla de ruedas y aumentar la seguridad del usuario de la silla de ruedas. El control de giro preciso también proporciona un control superior para personas con habilidades de movimiento severamente impedidas.
Ventajosamente, el módulo de control 9 ejecuta un algoritmo de control de guiñada autolimitante que detecta si el movimiento de la silla de ruedas 1 es inestable y, en respuesta, reduce la cantidad de potencia a las ruedas motrices 3 y 4 hasta que se reduce la inestabilidad de la silla de ruedas 1. Esto se logra supervisando las señales de error dentro del sistema de control y utilizando la magnitud de estas señales de error para limitar tanto la salida del lazo cerrado de control de la velocidad de guiñada como las señales de referencia de usuario introducidas.
El algoritmo autolimitante intenta mantener la estabilidad de la silla de ruedas 1 en todo momento y evita que la silla de ruedas 1 se comporte de manera agresiva cuando el lazo cerrado de control de velocidad de guiñada reacciona a grandes errores en el sistema.
Además, cuando se produce un fallo en el sensor, la magnitud y la duración de los errores que ocurren dentro del sistema de control de velocidad de guiñada son grandes y el algoritmo autolimitante reacciona desacelerando la silla de ruedas 1 sin provocar virajes importantes. Un fallo continuo hará que el algoritmo autolimitante reduzca la velocidad de la silla de ruedas 1 hasta que se detenga.
Con referencia ahora a la Figura 2 de los dibujos adjuntos, un sistema de control 20 para la silla de ruedas 1 comprende el módulo de control de entrada de usuario 6, el módulo de sensor de velocidad de guiñada 8 que comprende un sensor de velocidad de guiñada 8a y el módulo de control 9. El módulo de control 9, a su vez, comprende un microprocesador 21.
En una forma de realización preferida, el sensor de velocidad de guiñada 8a es un sensor de velocidad angular MEMS (Sistemas Micro electromecánicos), aunque se pueden utilizar otros tipos de sensores de velocidad angular. Según apreciarán los expertos en la técnica, el sensor de velocidad de guiñada 8a se debe montar de manera que su eje positivo (no mostrado) se alinee, en esencia, con el eje vertical de la silla de ruedas 1. Por lo tanto, según se ilustra en la Figura 2, el módulo de sensor de velocidad de guiñada 8 se sitúa mejor en la silla de ruedas 1 separado del módulo de control 9, de manera que no se establezcan restricciones en la orientación del módulo de control 9.
Alternativamente, el sensor de velocidad de guiñada 8a se puede alojar dentro del módulo de control 9, aunque esto requeriría montar el módulo de control 9 en la silla de ruedas 1 con una orientación que alinee el eje sensible a la guiñada positiva del sensor de velocidad de guiñada (no mostrado) con el eje vertical de la silla de ruedas 1.
El módulo de entrada de usuario 6 comprende el dispositivo de entrada de usuario 7 y un primer microcontrolador 22. En respuesta a la manipulación del usuario, el dispositivo de entrada de usuario 7 genera una señal de demanda de velocidad de avance (o retroceso) analógica (y) y una señal de demanda de velocidad de guiñada analógica (x) cuyos valores son indicativos, respectivamente, de la velocidad de avance (o de retroceso) y la velocidad de guiñada de la silla de ruedas 1 deseadas por el usuario.
El primer microcontrolador 22 recibe la señal de demanda de velocidad de avance analógica (y) y la señal de demanda de velocidad de guiñada (x) del dispositivo de entrada de usuario 7, convierte las señales en una señal de demanda de velocidad de avance digital (vi ) y una señal de demanda de velocidad de guiñada digital (ωi) respectivamente, y emite estas señales digitales en un formato de comunicaciones digitales adecuado, por ejemplo, la interfaz de comunicaciones serie (SCI) o la red de área del controlador (CAN) en un sistema BUS 23 conectado a un puerto de entrada de datos 24 del microprocesador 21.
El puerto de entrada de datos 24 decodifica y emite la señal de demanda de velocidad de avance digital (vi) a un bloque de acondicionamiento de la señal de velocidad de avance 25 y la señal de demanda de velocidad de guiñada digital (ωi) a un bloque de acondicionamiento de la señal de velocidad de guiñada 26. El bloque de acondicionamiento de la señal de velocidad de avance 25 procesa la señal de demanda de velocidad de avance (vi) para emitir una señal de velocidad de avance de referencia procesada (vr), y el bloque de acondicionamiento de la señal de guiñada 26 procesa la señal de demanda de velocidad de guiñada digital (ωi) para emitir una señal de velocidad de guiñada de referencia procesada (ωr). Este procesamiento filtra las señales para suavizarlas con el fin de evitar movimientos bruscos o erráticos de la silla de ruedas 1. Dicho procesamiento es bien conocido por los expertos en la técnica y no se describirá en detalle en la presente memoria.
Según se explicará con mayor detalle a continuación, en determinados casos cuando la silla de ruedas se mueve de manera inestable, el bloque de acondicionamiento de la señal de velocidad de avance 25 y el bloque de acondicionamiento de la señal de velocidad de guiñada 26 se disponen para reducir los valores de las señales de referencia de velocidad de avance y las señales de referencia de velocidad de guiñada para permitir que la silla de ruedas recupere la estabilidad.
El sensor de velocidad de guiñada 8a genera una señal de velocidad de guiñada analógica (z), que se emite a través de un cable 25 a un convertidor analógico digital (A/D) 28 en el procesador 21. El convertidor 28 digitaliza la señal y emite la señal digital (z') a un bloque de acondicionamiento de la señal de velocidad de guiñada del sensor 29.
El bloque de acondicionamiento de la señal de velocidad de guiñada del sensor 29 procesa la señal digital (z') para eliminar el desplazamiento de la señal de velocidad de guiñada del sensor 8a y para escalar (es decir, calibrar) la señal para generar una señal de velocidad de guiñada real (ωg) indicativa de la velocidad de guiñada en tiempo real de la silla de ruedas 1 en grados por segundo. El desplazamiento de la señal de velocidad de guiñada del sensor 8a se debe generalmente a una combinación de la salida del sensor de cero grados por segundo, más cualquier salida de error asociada de cero grados, por ejemplo, una causada por la deriva. De nuevo, las técnicas de procesamiento para eliminar este desplazamiento y escalar la señal son bien conocidas en la técnica y no se describirán en detalle en la presente memoria.
El sistema comprende además un lazo de control de guiñada que comprende un comparador 30, un compensador 31 y un limitador variable 32.
El comparador 30 recibe en una primera entrada (+) la señal de velocidad de guiñada de referencia limitada en velocidad (ωr) emitida desde el bloque de acondicionamiento de la señal de velocidad de guiñada 26, y en una segunda entrada (-) la señal de velocidad de guiñada real (ωg) emitida desde el bloque de acondicionamiento de la señal de velocidad de guiñada del sensor 29. El comparador 30 emite la diferencia entre la señal de velocidad de guiñada de referencia limitada en velocidad (ωr) y la señal de velocidad de guiñada real (ωg) para producir una señal de velocidad de guiñada de error (ωe) donde ωe = ωr - ωg. Por lo tanto, en cualquier momento dado, la señal de velocidad de guiñada de error representa la diferencia entre la velocidad de guiñada demandada por el usuario y la velocidad de guiñada real de la silla de ruedas, medida por el sensor 8a.
La señal de velocidad de guiñada de error (ωe) se envía a la entrada del compensador 31, normalmente un PI (integral proporcional) o un PID (derivativo integral proporcional), que calcula una señal de velocidad de guiñada correctiva (ωu) para utilizar en el control de los motores de accionamiento de la silla de ruedas para reducir la señal de velocidad de guiñada de error (ωe). De nuevo, los lazos de control PI y PID son bien conocidos en la técnica y, por lo tanto, no se describirán en la presente memoria.
La señal de velocidad de guiñada correctiva (ωu) se envía a la entrada del limitador variable 32 que funciona para limitar ωu a un valor dentro de las restricciones ± ωsat, dónde ωsat es un límite de saturación de velocidad de guiñada variable.
El limitador variable 32 por lo tanto emite una señal de velocidad de guiñada de corrección compensada (ωo) para ser utilizada para calcular las velocidades de referencia de los motores de accionamiento de la silla de ruedas y está dada por:
Un bloque de cálculo de la saturación 33 deriva continuamente el límite variable ωsat de acuerdo con las relaciones:
en donde:
ωsat es el límite de saturación de la velocidad de guiñada variable del limitador variable 32;
ωo es la señal de velocidad de guiñada compensada limitada emitida por el limitador variable 32;
ωr es la señal de velocidad de guiñada de referencia procesada descrita previamente;
ωe es la señal de velocidad de guiñada de error descrita previamente;
ωc es una constante programable que representa una velocidad de guiñada de corrección adicional (programable normalmente entre 50 y 150 grados por segundo)
kro es un valor para la ganancia del error de salida de la entrada del lazo de control (normalmente de 1 a 4) kd es un valor para la ganancia de la velocidad de guiñada de cambio (normalmente 8 a 32 con ΔT = 20 milisegundos);
ωe,Threshold es una constante preseleccionada, normalmente de 20 a 40 grados por segundo;
IoErrorThreshold es una constante preseleccionada, normalmente de 20 a 40 grados por segundo;
SlewRate es una constante preseleccionada normalmente de 50 a 150 grados por segundo por segundo.
Para realizar el cálculo, el bloque de cálculo de la saturación 33 se conecta a las salidas del bloque de acondicionamiento de la señal de velocidad de guiñada 26, al bloque de acondicionamiento de la señal del sensor de guiñada 29 y al limitador variable 32 para recibir como entrada las señales ωr, ωg, y ωo respectivamente y se preprograma con valores para las constantes.ωc, kro, kd, ωe,Threshold, IoErrorThreshold y SlewRate.
El propósito del limitador variable 32 es limitar la salida ωo en el caso de un fallo del sensor de velocidad de guiñada 8a o si produce inestabilidad en la silla de ruedas durante una maniobra. El limitador variable 32 logra esto al tener sus límites reducidos con las señales y la velocidad de cambio de las señales generadas dentro del sistema de control de guiñada. Los dos términos que son responsables de reducir el nivel de saturación del limitador variable son específicamente el término IoError y la velocidad de cambio de la señal de velocidad de guiñada real ωg.
El término IoError en el cálculo ωsat es responsable principalmente de la inestabilidad de la silla de ruedas. Por ejemplo, cuando se realiza una maniobra con una velocidad de avance alta, la silla de ruedas 1 puede ser incapaz de realizar la maniobra a alta velocidad debido a su dinámica o porque no haya suficiente potencia disponible de su disposición motriz. En consecuencia, el lazo de control de guiñada cerrado es incapaz de reducir la señal de velocidad de guiñada de error (ωe) a cero y el compensador 31 provoca un aumento en la salida del lazo de control de guiñada (ωo) dando lugar a un aumento en el término ioError. El término IoError creciente reduce el límite de saturación del limitador variable 32 ωsat provocando que el lazo de control de guiñada se sature más fácilmente.
Una vez que el lazo de control de guiñada se satura, el valor de la salida ωo es insuficiente para que la silla de ruedas 1 alcance la velocidad de guiñada indicada por la señal de demanda de velocidad de guiñada ωr (es decir, la velocidad de guiñada que el usuario desea que tenga la silla de ruedas 1) y la demanda de guiñada a la disposición motriz se restringe. Se hace necesario reducir la señal de velocidad de avance de referencia (vr) para reducir la velocidad de la silla de ruedas 1, de manera que la maniobra se pueda lograr a una velocidad de avance más estable y más lenta. En este caso, también resulta ventajoso reducir la señal de velocidad de guiñada de referencia ωr para forzar la señal de velocidad de guiñada de error ωe a que se reduzca y permitir que el límite de saturación del limitador variable (ωsat) recupere un valor más alto. Un procedimiento para reducir automáticamente la señal de velocidad de avance de referencia (vr) y la señal de velocidad de guiñada de referencia (ωr) cuando el lazo de control se satura se describirá más tarde a continuación.
El término indicativo de la velocidad de cambio de la señal de velocidad de guiñada real (ωg) en el cálculo de (ωsat) es principalmente sensible a fallos dentro del sistema de control de guiñada. Por ejemplo, en el caso de un fallo del sensor de velocidad de guiñada 8a, se produciría probablemente una señal de velocidad de guiñada de error (ωe) grande y el lazo de control de guiñada cerrado reaccionaría aumentando su salida (ωo) hasta un valor alto correspondiente. En consecuencia, se aplicaría una demanda de velocidad de guiñada alta a los motores, lo que provocaría que la silla de ruedas 1 girara bruscamente o hiciese trompos fuera de control.
El cálculo del término de la velocidad de cambio en el ωsat evita esto reduciendo rápidamente ωsat para limitar la salida del lazo de control de guiñada cerrado cuando se detecta un cambio rápido en la señal de velocidad de guiñada real (ωg). Esto evita un giro brusco o trompo de la silla de ruedas. El término de la velocidad de cambio también es útil para recuperar rápidamente la estabilidad si la silla de ruedas pierde bruscamente el control. El bloque de cálculo de la saturación 33 diferencia continuamente la señal de velocidad de guiñada real (ωg) y en cada ciclo de cálculo determina un valor de velocidad de guiñada de cambio actual y compara este valor con el valor utilizado de la velocidad de guiñada de cambio en el ciclo de cálculo anterior para determinar el valor de saturación ωsat. Si el valor actual de la velocidad de guiñada de cambio es el valor más alto, se utiliza en ese ciclo de cálculo para determinar el siguiente valor de saturación ωsat, de lo contrario se desecha.
Los valores para las constantes ωe,Threshold, IoErrorThreshold se seleccionan de manera que, en condiciones normales de funcionamiento de la silla de ruedas (es decir, la silla de ruedas se mueve de manera estable y el sistema detector de velocidad de guiñada funciona correctamente) las condiciones |ωe| < ωe,Threshold y IoError < IoErrorThreshold se cumplen.
Cuando se cumplen estas condiciones y el bloque de cálculo de la saturación 33 determina en un ciclo de cálculo actual que el valor medido de la velocidad de guiñada de cambio actual Kd es más bajo que el valor utilizado de la velocidad de guiñada de cambio en el ciclo de cálculo anterior para determinar el valor de saturación ωsat, el valor utilizado de la velocidad de guiñada de cambio en el ciclo de cálculo anterior menos el valor de la constante SlewRate es el valor utilizado en ese ciclo de cálculo para determinar el siguiente valor de
saturación ωsat. Por lo tanto, el valor de la velocidad de guiñada de cambio Kd se reduce con la velocidad de giro en cada cálculo consecutivo hasta que se determina que el valor medido de la velocidad de guiñada de cambio actual Kd es más alto y se utiliza este valor más alto.
El sensor de velocidad de guiñada 8a se conecta firmemente al chasis de la silla de ruedas 1 y, en condiciones normales de funcionamiento, la masa de la silla de ruedas evita que el sensor de guiñada 8a experimente aceleraciones de guiñada anormalmente altas y, por lo tanto, no se producen cambios rápidos en la salida del sensor de guiñada 8a.
En el caso de un fallo dentro del sistema detector de velocidad de guiñada, la señal de velocidad de guiñada real ωg recibida por el bloque de cálculo de la saturación 33 es probable que sea erróneo y tenga un valor que haya saltado bruscamente en relación con el valor de la señal previa al fallo. En consecuencia, el bloque de cálculo de la saturación 33 generará un gran valor para Kd y de acuerdo con la ecuación anterior se reducirá el nivel de saturación del limitador variable ωsat para saturar la salida y evitar de este modo o al menos hacer menos probable, un giro brusco de la silla de ruedas 1.
Un fallo en el sistema detector de velocidad de guiñada también provocará un aumento inmediato en el valor de la señal de velocidad de guiñada de error ωe. En una forma de realización preferida, siempre que tanto el valor de la señal de velocidad de guiñada de error ωe como el valor del término IoError permanezcan por encima de los umbrales respectivos ωe,Threshold y IoErrorThreshold la velocidad de cambio relativamente alta del término de la velocidad de guiñada Kd utilizada para calcular el nivel de saturación del limitador variable ωsat se bloquea (es decir, se mantiene constante) para cada ciclo de cálculo consecutivo. Esto tiende a disminuir el límite de saturación del limitador variable ωsat y da como resultado la restricción de la demanda de guiñada a la disposición motriz. Si el fallo se mantiene y, en consecuencia, la señal de velocidad de guiñada de error ωe y/o el valor del término IoError permanecen por encima de sus respectivos umbrales, la demanda de guiñada a la disposición motriz permanece restringida y se mejora la seguridad de la silla de ruedas.
Si el fallo es un fallo temporal o la velocidad de cambio alta del término de la velocidad de guiñada Kd se produce a causa de una pérdida brusca de la estabilidad en lugar de un fallo del sensor de velocidad de guiñada, el limitador variable limita temporalmente la demanda de guiñada a la silla de ruedas hasta que el error de velocidad de guiñada (ωe) y el término ioError se reducen por debajo de sus umbrales determinados. El término de velocidad de guiñada de cambio se reduce a continuación a la velocidad de giro determinada para permitir que el lazo de control de guiñada se recupere y regrese a la operación normal.
Se puede entender a partir de la ecuación anterior que cuando el valor de ωe es pequeño, el valor del término IoError es correspondientemente pequeño. Por lo tanto, siempre que Kd sea también pequeño, ωsat tiende hacia ωsat = |ωr| ωc. Estas condiciones tienden a cumplirse cuando la silla de ruedas 1 se desplaza de forma estable y, en tales circunstancias, la constante ωc asegura que el valor de ωsat permanece más alto que ωr. Esto ayuda a hacer que la sensación de conducir la silla de ruedas sea cómoda para el ocupante de la silla de ruedas. La constante ωc también garantiza que cuando sea necesario para recuperar la estabilidad, la señal de velocidad de guiñada de corrección ωu puede provocar que se aplique una mayor demanda de velocidad de guiñada a la disposición motriz que la requerida por la señal de velocidad de guiñada de referencia (ωr).
Utilizar el limitador variable 32 para generar la señal de velocidad de guiñada compensada ωo, mejora la estabilidad de la silla de ruedas 1. Si la silla de ruedas 1 se gira de manera inestable el valor ωsat se reduce automáticamente y puede llegar a ser inferior a ωu. En consecuencia, la potencia a las ruedas motrices se restringe hasta que se recupere la estabilidad.
Se realizan mejoras adicionales en la estabilidad de la silla de ruedas si la señal de velocidad de avance de referencia (νr) y la señal de velocidad de guiñada de referencia (ωr) se reducen automáticamente cuando la magnitud de la señal de salida ωu del limitador variable 32 se limita por ωsat.
Si se produce esta condición, se transmite una señal desde el limitador variable 32 al bloque de acondicionamiento de la velocidad de avance 25 y el bloque de acondicionamiento de la señal de velocidad de guiñada 26 que, en respuesta, reduce la señal de velocidad de avance de referencia (νr) y la señal de velocidad de guiñada de referencia (ωr) respectivamente, de acuerdo con las ecuaciones:
en donde kfdecel es un factor de ponderación de desaceleración de avance de referencia o constante preseleccionada (normalmente es 1 a 4), kydecel es un factor de ponderación de desaceleración de guiñada de referencia o constante preseleccionada (normalmente es 1 a 4) y ΔT es el tiempo de muestreo (normalmente 10 a 50 milisegundos).
Para este fin (aunque por simplicidad no se ilustra en la Figura 2), el bloque de acondicionamiento de la velocidad de avance 25 se conecta a las salidas del bloque de acondicionamiento de la señal de velocidad de giro 26 y al limitador variable 32 para recibir como entrada las señales respectivas ωr y ωo requeridas para calcular el término IoError utilizado en el cálculo de desaceleración de avance de referencia.
De manera similar, (aunque de nuevo por simplicidad no se ilustra en la Figura 2) el bloque de acondicionamiento de la señal de velocidad de giro 26 se conecta a la salida del limitador variable 32 para recibir como entrada la seña ωo requerida con la señal ωr (generada por el propio bloque de acondicionamiento de la señal de velocidad de giro 26) para calcular el término IoError utilizado en el cálculo de desaceleración de guiñada de referencia.
Se apreciará que el bloque de acondicionamiento de la velocidad de avance 25 y el bloque de acondicionamiento de la señal de velocidad de giro 26 se preprogramen con las constantes kfdecel, kydecel y kro utilizadas en estos cálculos.
De estas ecuaciones se puede entender que cuanto mayor sea el valor de ωe (y, por tanto, cuanto mayor sea la inestabilidad en el movimiento de la silla de ruedas), más rápidamente se desacelera la silla de ruedas.
Si se recupera la estabilidad de manera que la señal de salida ωu del limitador variable 32 ya no esté limitada por ωsat, una señal adicional se transmite desde el limitador variable 32 al bloque de acondicionamiento de la velocidad de avance 25 y el bloque de acondicionamiento de la señal de velocidad de guiñada 26, que en respuesta cesa la desaceleración automática de la silla de ruedas 1. Se apreciará que, en caso de inestabilidad contante, por ejemplo, después de un fallo del sensor de velocidad de guiñada 8a, la silla de ruedas se desacelerará hasta detenerse por completo sin desviarse significativamente. Se apreciará que, en el caso de que la salida del lazo de control de guiñada se sature, limitar la señal de referencia de avance (vr) y la señal de velocidad de guiñada de referencia (ωr) permite que la silla de ruedas recupere la estabilidad de forma más segura y de una manera controlada.
Las salidas del limitador variable 32 ωo y del bloque de acondicionamiento de la señal de velocidad de avance vr se envían a un bloque de cálculo de referencia del motor 34 que calcula las velocidades de referencia del motor izquierdo y derecho nmotor izquierdo y nmotor derecho dónde:
kv es el escalador de velocidad del motor
Las velocidades de referencia del motor izquierdo y derecho nmotor izquierdo y nmotor derecho se envían a sus respectivos bloques de control de velocidad y par 35 y 36 que, de manera estándar, realizan el control de lazo cerrado de la velocidad del motor y el par motor y emiten valores numéricos de PWM (modulación de ancho de pulso) PWMizquierdo y PWMderecho que se envían a un controlador PWM 37. El controlador PWM 37 convierte los valores numéricos PWM PWMizquierdo y PWMderecho a señales de accionamiento de onda cuadrada cuyos ciclos de trabajo son proporcionales a los valores PWM numéricos y estas señales se utilizan para cambiar la electrónica de potencia 38 para controlar la potencia del motor izquierdo 39 y el motor derecho 40 para accionar las ruedas izquierda y derecha de la silla de ruedas, respectivamente.
La utilización de estas técnicas para controlar los motores de accionamiento de la silla de ruedas permite mejorar la estabilidad de la silla de ruedas. Por ejemplo, es menos probable que la silla de ruedas haga trompos fuera de control cuando se pierde la tracción de las ruedas motrices, o que se desvíe cuando se conduce por un peralte o que se desvíe si las presiones de los neumáticos izquierdo y derecho no son iguales. La sensación general de conducir la silla de ruedas se ha mejorado para la utilización y es menos probable que la silla de ruedas se desvíe del rumbo de desplazamiento previsto por el usuario al conducir sobre obstáculos.
La Figura 3 ilustra un sistema de control alternativo 20' para controlar la silla de ruedas 1. El sistema de control 20' es muy similar al sistema de control ilustrado en la Figura 2 y a las características idénticas se les han dado números de referencia idénticos. La única diferencia entre los dos sistemas es que en el sistema de control 20' el sensor de velocidad de guiñada 8 se proporciona en un módulo 50 junto con un segundo microcontrolador 51. El segundo microcontrolador 51 recibe la señal de velocidad de guiñada (z) del sensor de velocidad de guiñada 8, convierte la señal en una señal digital y emite la señal digital en un formato de comunicaciones digitales adecuado, por ejemplo, la interfaz de comunicaciones en serie (SCI) o la red de área del controlador (CAN) en el sistema BUS 23 conectado al puerto de entrada de datos 24 del microprocesador 21. La señal digital se envía desde el puerto de entrada de datos 24 para su procesamiento en el bloque de acondicionamiento de la señal de velocidad de guiñada del sensor 29, como se describió anteriormente en la presente memoria.
Se apreciará que las formas de realización de la invención no se limiten a la relación precisa para determinar ωsat como lo dado anteriormente. En particular, las formas de realización de la invención pueden hacer uso de uno u otro de los términos YawRateOfChangen y ioError para determinar ωsat. Otras variaciones de la relación para determinar ωsat serán evidentes para el experto.
Además, se pueden utilizar ecuaciones diferentes de las descritas anteriormente para determinar las velocidades de desaceleración de avance y de la velocidad de guiñada de referencia, por ejemplo
Kvr = factor de ponderación de desaceleración de avance de referencia (kvr > = 0).
Kvω = factor de ponderación de la desaceleración de velocidad de guiñada de referencia (Kvω > = 0).
kωe = factor de ponderación del error de velocidad de guiñada (kωe > = 0).
kωro = factor de ponderación del error de salida de la entrada del lazo de control (kωro > = 0).
ΔT = tiempo de muestreo en segundos
Habiendo descrito de este modo la presente invención haciendo referencia a una forma de realización preferida, se debe entender bien que la forma de realización en cuestión es solo un ejemplo y que se pueden realizar modificaciones y variaciones tales como las que se le ocurrirán a aquellos que posean el conocimiento y habilidades apropiados sin apartarse del alcance de la invención según se describe en las reivindicaciones adjuntas y equivalentes de las mismas. En las reivindicaciones, cualesquiera signos de referencia colocados entre paréntesis no se deben interpretar como una limitación de las reivindicaciones. La palabra "que comprende" y "comprende", y similares, no excluyen la presencia de elementos o etapas distintas a las enumeradas en cualquier reivindicación o en la memoria descriptiva en su conjunto. La referencia singular de un elemento no excluye la referencia plural de dichos elementos.
Claims (15)
1. Un sistema que comprende:
una disposición motriz que comprende dos motores eléctricos accionados independientemente (39, 40) para accionar de manera diferente las ruedas izquierda y derecha de un vehículo motorizado:
un sistema de control (20) para controlar la disposición motriz; caracterizado por que el sistema de control comprende:
un lazo de control de retroalimentación de velocidad de guiñada que comprende:
un comparador (30) para recibir una señal de velocidad de guiñada del sensor (8a) de un sensor de velocidad de guiñada, siendo la señal de velocidad de guiñada del sensor indicativa de una velocidad de guiñada real del vehículo y para recibir una señal de velocidad de guiñada de referencia generada por un dispositivo de entrada de usuario, siendo la señal de velocidad de guiñada de referencia indicativa de una velocidad de guiñada demandada por el usuario para el vehículo, el comparador dispuesto para emitir una señal de velocidad de guiñada de error basada en una diferencia entre la señal de velocidad de guiñada del sensor y la señal de velocidad de guiñada de referencia;
un limitador variable (32) para limitar una señal de velocidad de guiñada de corrección a valores dentro de un límite variable, la señal de velocidad de guiñada de corrección para controlar la disposición motriz para reducir la señal de velocidad de guiñada de error;
un compensador (31) entre el comparador (30) y el limitador variable para recibir como entrada la señal de velocidad de guiñada de error y generar en respuesta a la misma la señal de velocidad de guiñada de corrección;
un calculador de límites para calcular continuamente el límite variable en función de una o más señales de entrada y/o generadas por el lazo de control.
2. Un sistema de acuerdo con la reivindicación 1, en donde:
i) en cualquier momento dado, el calculador de límites calcula el límite variable al menos en parte en función de un valor de un término que depende de una diferencia entre un valor actual de la señal de velocidad de guiñada de referencia y un valor actual de la señal de velocidad de guiñada de corrección; y/o
ii) durante un primer ciclo de cálculo, el calculador de límites calcula un primer valor de velocidad de cambio utilizando un primer valor actual de la velocidad de cambio de la señal de velocidad de guiñada del sensor y calcula el límite variable al menos en parte, en función del primer valor de velocidad de cambio.
3. Un sistema de acuerdo con la reivindicación 2, en donde durante un segundo ciclo de cálculo inmediatamente después del primer ciclo de cálculo, el calculador calcula un segundo valor de velocidad de cambio utilizando un segundo valor actual de la velocidad de cambio de la señal de velocidad de guiñada del sensor y calcula el límite variable al menos en parte en función del segundo valor de velocidad de cambio si es más alto que el primer valor de velocidad de cambio.
4. Un sistema de acuerdo con la reivindicación 3, en donde durante el segundo ciclo de cálculo, si el primer valor de velocidad de cambio es mayor que el segundo valor de velocidad de cambio, el primer valor de velocidad de cambio se reduce en una cantidad predeterminada y el calculador calcula el límite variable, al menos en parte, en función del primer valor de velocidad de cambio reducido.
5. Un sistema de acuerdo con la reivindicación 2, en donde el calculador bloquea el primer valor de velocidad de cambio si se exceden uno o más valores umbrales de control y calcula el límite variable al menos en parte en función del primer valor de velocidad de cambio durante cada período de cálculo posterior siempre que los valores de los umbrales de control permanezcan sobrepasados.
6. Un sistema de acuerdo con las reivindicaciones 4 o 5, en donde el uno o más valores umbrales comprenden un valor de umbral para la señal de velocidad de guiñada de error o un valor de umbral para una diferencia entre los valores actuales de la señal de velocidad de guiñada de referencia y la señal de velocidad de guiñada de corrección.
7. Un sistema de acuerdo con cualquier reivindicación precedente, comprendiendo además el sistema un bloque de procesamiento de la señal de velocidad de guiñada de referencia (26) para procesar la señal de velocidad de guiñada de referencia recibida desde el dispositivo de entrada de usuario (7) y emitir una señal de velocidad de guiñada de referencia procesada al comparador, el bloque de procesamiento de la señal de velocidad de guiñada de referencia (26) dispuesto para reducir el valor de la señal de velocidad de guiñada de
referencia cuando el valor de la señal de velocidad de guiñada de corrección se satura por el limitador variable (32).
8. Un sistema de acuerdo con la reivindicación 7, en donde el bloque de procesamiento de la señal de velocidad de guiñada de referencia se dispone para reducir el valor de la señal de velocidad de guiñada de referencia a una velocidad que depende de la diferencia entre un valor actual de la señal de velocidad de guiñada de referencia y la señal de velocidad de guiñada de corrección.
9. Un sistema de acuerdo con cualquier reivindicación precedente, en donde el sistema comprende además un bloque de procesamiento de la señal de velocidad de referencia para procesar una señal de velocidad de referencia recibida desde el dispositivo de entrada de usuario (7) indicativa de una velocidad demandada por el usuario para el vehículo y emitir una señal de velocidad de referencia procesada para utilizar en el control de la disposición motriz, el bloque de procesamiento de la señal de velocidad de referencia dispuesto para reducir el valor de la señal de velocidad de referencia cuando el valor de la señal de velocidad de guiñada de corrección se satura por el limitador variable.
10. Un sistema de acuerdo con la reivindicación 9, en donde el bloque de procesamiento de la señal de velocidad de referencia se dispone para reducir el valor de la señal de velocidad de referencia a una velocidad que depende de la diferencia entre un valor actual de la señal de velocidad de guiñada de referencia y la señal de velocidad de guiñada de corrección.
11. Un sistema de acuerdo con cualquier reivindicación precedente, en donde el calculador de límites calcula el límite variable al menos en parte en función de un valor de una constante programable, seleccionado el valor de tal manera que, cuando sea necesario, la señal de velocidad de guiñada de corrección pueda aplicar una mayor demanda de velocidad de guiñada a la disposición motriz (39, 40) que una velocidad de guiñada actual demandada por el usuario indicada por la señal de velocidad de guiñada de referencia.
12. Un sistema de acuerdo con cualquier reivindicación precedente, en donde, al calcular el límite variable en cualquier momento dado, el calculador de límites resta un valor calculado en función de la una o más señales de entrada y/o generadas por el lazo de control a partir de la suma de un valor actual de la señal de velocidad de guiñada de referencia y un valor adicional.
13. Un sistema de acuerdo con la reivindicación 12, en donde el valor adicional es una constante predeterminada.
14. Un sistema de acuerdo con cualquier reivindicación precedente, en donde el compensador (31) es un compensador PI o PID.
15. Un vehículo motorizado que comprende un sistema según se reivindica en cualquier reivindicación precedente, en donde preferiblemente el vehículo es una silla de ruedas (1).
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
GB0623895A GB2444963B (en) | 2006-11-30 | 2006-11-30 | A control system for controlling a motor arrangement for differentially driving left and right wheels of a motorized vehicle |
PCT/GB2007/002720 WO2008065322A1 (en) | 2006-11-30 | 2007-07-19 | A control system for controlling a motor arrangement for differentially driving left and right wheels of a motorized vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
ES2702982T3 true ES2702982T3 (es) | 2019-03-06 |
Family
ID=37671572
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
ES07766288T Active ES2702982T3 (es) | 2006-11-30 | 2007-07-19 | Un sistema de control para controlar una disposición motriz para accionar de manera diferencial las ruedas izquierda y derecha de un vehículo motorizado |
Country Status (5)
Country | Link |
---|---|
US (1) | US8527148B2 (es) |
EP (1) | EP2086789B1 (es) |
ES (1) | ES2702982T3 (es) |
GB (1) | GB2444963B (es) |
WO (1) | WO2008065322A1 (es) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2447987B (en) * | 2007-03-30 | 2011-11-02 | P G Drives Technology Ltd | Method and apparatus for determining a value of a zero point offset of a yaw rate sensor |
GB2468385B (en) * | 2007-03-30 | 2011-11-16 | P G Drives Technology Ltd | Method and apparatus for determining a value of a zero point offset of a yaw rate sensor |
US8195357B2 (en) * | 2008-04-16 | 2012-06-05 | GM Global Technology Operations LLC | In-vehicle sensor-based calibration algorithm for yaw rate sensor calibration |
GB2469654B (en) * | 2009-04-21 | 2013-10-09 | Penny & Giles Controls Ltd | A controller and control method for a motorised vehicle |
GB2478956B (en) * | 2010-03-24 | 2015-04-22 | Penny & Giles Controls Ltd | A controller and control method for a motorised vehicle |
GB2478957B (en) * | 2010-03-24 | 2014-07-09 | Penny & Giles Controls Ltd | A controller and control method for a motorised vehicle |
GB2486179B (en) | 2010-12-03 | 2014-12-17 | Penny & Giles Controls Ltd | Front wheel drive motorised vehicle control using acceleration measurements |
JP6423190B2 (ja) * | 2014-07-15 | 2018-11-14 | 株式会社Subaru | 車両の挙動制御装置及び車両の挙動制御方法 |
JP6479627B2 (ja) * | 2015-10-29 | 2019-03-06 | 株式会社クボタ | 電動作業車 |
RU2667482C1 (ru) * | 2016-06-24 | 2018-09-20 | Общество с ограниченной ответственностью "НАУЧНО-ПРОИЗВОДСТВЕННОЕ ПРЕДПРИЯТИЕ "ИНКАР-М" | Многоосевой преобразователь электропривода |
US10864127B1 (en) | 2017-05-09 | 2020-12-15 | Pride Mobility Products Corporation | System and method for correcting steering of a vehicle |
US11160704B2 (en) * | 2018-01-15 | 2021-11-02 | Vrmeco Llc | Joystick chair |
US11654062B2 (en) * | 2020-11-10 | 2023-05-23 | Exo-Seat LLC | Wheelchair harness |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB232719A (en) * | 1924-02-05 | 1925-04-30 | Francis William James Robinson | Improvements in or relating to visible signal devices for use on motor-cars and other vehicles |
US5636909A (en) * | 1993-12-01 | 1997-06-10 | Mazda Motor Corporation | Traction control system for vehicle |
JP3269421B2 (ja) * | 1997-04-04 | 2002-03-25 | 三菱自動車工業株式会社 | 車両の自動減速制御装置 |
US6789640B1 (en) * | 2000-10-13 | 2004-09-14 | Deka Products Limited Partnership | Yaw control for a personal transporter |
US6202773B1 (en) * | 1999-07-30 | 2001-03-20 | Invacare Corporation | Motorized wheelchairs |
JP4394304B2 (ja) * | 2001-04-24 | 2010-01-06 | 富士重工業株式会社 | 車両運動制御装置 |
JP2003070849A (ja) * | 2001-08-30 | 2003-03-11 | Fuji Heavy Ind Ltd | 電動車椅子の制御装置 |
US6704622B2 (en) * | 2001-12-28 | 2004-03-09 | Visteon Global Technologies, Inc. | Vehicle stability control |
DE10393559D2 (de) | 2002-11-08 | 2005-11-03 | Continental Teves Ag & Co Ohg | Verfahren und Einrichtung zum Stabilisieren eines Gespanns |
US6909959B2 (en) * | 2003-03-07 | 2005-06-21 | Stephen James Hallowell | Torque distribution systems and methods for wheeled vehicles |
CA2578196C (en) * | 2004-10-08 | 2014-04-01 | Segway Inc. | Vehicle control by pitch modulation |
-
2006
- 2006-11-30 GB GB0623895A patent/GB2444963B/en not_active Expired - Fee Related
-
2007
- 2007-07-19 EP EP07766288.0A patent/EP2086789B1/en active Active
- 2007-07-19 ES ES07766288T patent/ES2702982T3/es active Active
- 2007-07-19 US US12/516,393 patent/US8527148B2/en active Active
- 2007-07-19 WO PCT/GB2007/002720 patent/WO2008065322A1/en active Application Filing
Also Published As
Publication number | Publication date |
---|---|
US8527148B2 (en) | 2013-09-03 |
US20100114433A1 (en) | 2010-05-06 |
EP2086789B1 (en) | 2018-10-03 |
GB2444963A (en) | 2008-06-25 |
EP2086789A1 (en) | 2009-08-12 |
WO2008065322A1 (en) | 2008-06-05 |
GB0623895D0 (en) | 2007-01-10 |
GB2444963B (en) | 2010-03-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
ES2702982T3 (es) | Un sistema de control para controlar una disposición motriz para accionar de manera diferencial las ruedas izquierda y derecha de un vehículo motorizado | |
CA2677751C (en) | Motorized wheelchair | |
EP3420417B1 (en) | Mobility device control system | |
EP1278651B1 (en) | Motorized wheelchairs | |
US6202773B1 (en) | Motorized wheelchairs | |
US8315770B2 (en) | Motorized wheelchair | |
EP1512055B1 (en) | Hybrid human/electric powered vehicle | |
US8423274B2 (en) | Vehicle | |
US10232871B2 (en) | Pushcart | |
US20100168993A1 (en) | Vehicle | |
CN102774453B (zh) | 智能平衡车*** | |
WO2008026725A1 (fr) | Vehicule |