Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
IMPROVED METHOD FOR CORRECTING A TRAJECTORY IN A PERSONAL MOVEMENT ASSISTANCE DEVICE EQUIPPED WITH SENSORS
Document Type and Number:
WIPO Patent Application WO/2016/151230
Kind Code:
A1
Abstract:
Method for correcting a movement trajectory in a personal assistance device (DADP) equipped with at least one sensor device (USCAP) and a control unit (UC), the method comprising measuring the distance between the at least one sensor (USCAP) and an obstacle, separating a reference frame (P) representing pairs (CV1ω1) of values of translational speeds (V1) and rotational speeds (ω1) into two half-planes, using at least one separation straight line (LP) of the reference frame (P), into an exclusion zone and an admissible movement space (MA), defining a second rotational speed (ω2) and a second translational speed (V2) by projecting a control point (CP) into the delimited admissible space (MA).

Inventors:
PASTEAU FRANÇOIS (FR)
BABEL MARIE (FR)
BAZIN ERIC (FR)
GUEGAN SYLVAIN (FR)
Application Number:
PCT/FR2016/050621
Publication Date:
September 29, 2016
Filing Date:
March 21, 2016
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
INST NAT DES SCIENCES APPLIQUEES DE RENNES (INSA RENNES) (FR)
International Classes:
G05D1/02; A61G5/04
Domestic Patent References:
WO2014011992A22014-01-16
WO2014148978A12014-09-25
Foreign References:
JPH07110711A1995-04-25
US20120101703A12012-04-26
JPH07110711A1995-04-25
Attorney, Agent or Firm:
NOVAGRAAF TECHNOLOGIES (FR)
Download PDF:
Claims:
REVENDICATIONS

1. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement d'au moins une personne, ledit dispositif (DADP) d'aide au déplacement étant mû par au moins un moteur (M1 ) et dirigé par un module de contrôle de direction (DCTRL), selon une première vitesse de rotation (ω1 ) et une première vitesse de translation (V1 ) déterminées en fonction d'une ou plusieurs consignes (DCTRL, VCTRL) reçues au moyen d'une interface (CTRL- IN) d'entrée, lesdites valeurs de vitesses (V1 , ω1 ) constituant les coordonnées d'un point de commande (CP) dans un repère de déplacement (P), ledit dispositif (DADP) d'aide au déplacement étant équipé d'au moins un dispositif capteur (USCAP) et d'une unité de contrôle (UC), ledit dispositif capteur (USCAP) étant configuré pour opérer une mesure dans une direction (DO) définie par rapport à l'axe de déplacement dudit dispositif (DADP) d'aide au déplacement, ladite méthode comprenant une mesure d'une distance (s) entre ledit au moins un capteur (USCAP) ou un point prédéterminé dudit dispositif d'aide au déplacement (DADP) et un obstacle présent dans ladite direction (DO), et ladite méthode étant caractérisée en ce qu'elle comprend :

- une séparation, en fonction notamment de ladite distance (s) mesurée, dudit repère (P) de représentation de couples (Cv-ΐωΐ ) desdites valeurs de vitesses de translation (V1 ) et de vitesse de rotation (ω1 ) en demi-plans par au moins une droite de séparation (LP), l'un desdits demi-plans dudit repère (P) correspondant à un espace admissible au déplacement, (MA), l'autre desdits deux demi-plans correspondant à un une zone d'exclusion au déplacement dudit dispositif (DADP) d'aide au déplacement,

- une détermination d'une seconde vitesse de rotation (ω2) et d'une seconde vitesse de translation(V2) par projection dudit point de commande (CP) dans ledit espace admissible (MA), - un contrôle du ou desdits moteur (M1 ) et dudit module de contrôle de direction (DCTRL) en fonction, respectivement, de ladite seconde vitesse de translation (V2) et de la seconde vitesse de rotation (ω2) précédemment déterminées.

2. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 , caractérisée en ce que ladite projection dudit point de commande (CP) dans ledit espace admissible (MA) s'effectue par la détermination d'un point de contrôle (CTRLP) appartenant à une droite du repère (P) passant par l'origine du repère et par le dit point de commande (CP).

3. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 , caractérisée en ce que ladite projection dudit point de commande (CP) dans ledit espace admissible (MA) s'effectue par la détermination d'un point de contrôle (CTRLP) appartenant à une droite perpendiculaire à ladite au moins une droite de séparation LP la plus proche dudit point de commande (CP).

4. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 caractérisée en ce que ladite projection dudit point de commande (CP) dans ledit espace admissible (MA) s'effectue par la détermination d'un point de contrôle (CTRLP) appartenant à une droite horizontale passant par ledit point de commande (CP).

5. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon l'une quelconque des revendications précédentes caractérisée en ce qu'elle comprend en outre, préalablement à ladite projection dudit point de commande (CP), une étape de gestion de l'inertie mécanique dudit dispositif (DADP) comprenant un changement de repère dudit premier repère (P) vers un second repère (Ρ'), ledit changement de repère comprenant une réduction dudit premier repère £P) par le biais d'une diminution homothétique et un décalage vers les valeurs positives des vitesses en translation (V1 ) de l'origine dudit premier repère (P) donnant naissance à une origine dudit second repère (Ρ').

Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 caractérisée en ce que ladite projection dudit point de commande (CP) projeté en un point de contrôle (CTRLP) de l'espace admissible (MA) est telle que ledit point de contrôle (CTRLP) est positionné a une distance inférieure à une valeur prédéterminée (L) de ladite au moins une droite de séparation (LP).

Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 caractérisée en ce qu'elle comprend une détermination d'au moins autant de droites de séparation (LP) que de capteurs (USCAP) présents sur ledit dispositif d'aide au déplacement (DADP).

Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon l'une quelconque des revendications 1 à 7, caractérisé en ce qu'une équation de ladite au moins une droite de séparation en demi-plans dans ledit repère (P) est :

Jv v + Jffl ω < λ (s-s*)

v est une vitesse instantanée en translation dudit dispositif (DADP), ω est une vitesse instantanée en rotation dudit dispositif (DADP), λ est une constante,

s est ladite distance mesurée et

s* est une distance minimale à l'obstacle, Jv et Jco sont des composantes scalaires respectivement définies à partir des vitesses °v et °ω du capteur correspondant dans le repère

(ω,ν)- Produit programme d'ordinateur, caractérisé en ce qu'il comprend des instructions de code de programme pour exécuter les étapes de la méthode selon l'une quelconque des revendications 1 à 8, lorsque ledit programme est exécuté sur un ordinateur.

REVENDICATIONS MODIFIÉES

reçues par le Bureau international le 29 Août 2016 (29.08.2016)

1. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement d'au moins une personne, ledit dispositif (DADP) d'aide au déplacement étant mû par au moins un moteur (M1 ) et dirigé par un module de contrôle de direction (DCTRL), selon une première vitesse de rotation (u 1 ) et une première vitesse de translation (V1 ) déterminées en fonction d'une ou plusieurs consignes (DCTRL, VCTRL) reçues au moyen d'une interface (CTRL-IN) d'entrée, lesdites valeurs de vitesses (V1 , ω1 ) constituant les coordonnées d'un point de commande (CP) dans un repère de déplacement (P), ledit dispositif (DADP) d'aide au déplacement étant équipé d'au moins un dispositif capteur (USCAP) et d'une unité de contrôle (UC), ledit dispositif capteur (USCAP) étant configuré pour opérer une mesure dans une direction (D0) définie par rapport à l'axe de déplacement dudit dispositif (DADP) d'aide au déplacement, ladite méthode comprenant une mesure d'une distance (s) entre ledit au moins un capteur (USCAP) ou un point prédéterminé dudit dispositif d'aide au déplacement (DADP) et un obstacle présent dans ladite direction (D0), et ladite méthode étant caractérisée en ce qu'elle comprend :

- une séparation, en fonction notamment de ladite distance (s) mesurée, dudit repère (P) de représentation de couples (Cviwi) desdites valeurs de vitesses de translation (V1 ) et de vitesse de rotation (ω1 ) en demi-plans par au moins une droite de séparation (LP), l'un desdits demi-plans dudit repère

(P) correspondant à un espace admissible au déplacement, (MA), l'autre desdits deux demi-plans correspondant à un une zone d'exclusion au déplacement dudit dispositif (DADP) d'aide au déplacement,

- une détermination d'une seconde vitesse de rotation (ω2) et d'une seconde vitesse de translation(V2) par projection dudit point de commande

(CP) dans ledit espace admissible (MA

- un contrôle du ou desdits moteur (M1 ) et dudit module de contrôle de direction (DCTRL) en fonction, respectivement, de ladite seconde vitesse de translation (V2) et de la seconde vitesse de rotation (u>2) précédemment déterminées, ladite au moins une droite de séparation étant définie par l'équation :

v est une vitesse instantanée en translation dudit dispositif (DADP), ω est une vitesse instantanée en rotation dudit dispositif (DADP), λ est une constante,

s est ladite distance mesurée, et

s* est une distance minimale à l'obstacle, et

Jv et Jio sont des composantes scalaires respectivement définies à partir des vitesses cv et ci~> du capteur correspondant dans le repère (ω,ν).

2. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 , caractérisée en ce que ladite projection dudit point de commande (CP) dans ledit espace admissible (MA) s'effectue par la détermination d'un point de contrôle (CTRLP) appartenant à une droite du repère (P) passant par l'origine du repère et par le dit point de commande (CP).

3. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 , caractérisée en ce que ladite projection dudit point de commande (CP) dans ledit espace admissible (MA) s'effectue par la détermination d'un point de contrôle (CTRLP) appartenant à une droite perpendiculaire à ladite au moins une droite de séparation LP la plus proche dudit point de commande (CP).

4. Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 caractérisée en ce que ladite projection dudit point de commande (CP) dans ledit espace

. admissible (MA) s'effectue par la détermination d'un point de contrôle (CTRLP) appartenant à une droite horizontale passant par ledit point de commande (CP). Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon l'une quelconque des revendications précédentes caractérisée en ce qu'elle comprend en outre, préalablement à ladite projection dudit point de commande (CP), une étape de gestion de l'inertie mécanique dudit dispositif (DADP) comprenant un changement de repère dudit premier repère (P) vers un second repère (Ρ'), ledit changement de repère comprenant une réduction dudit premier repère [P] par le biais d'une diminution homothétique et un décalage vers les valeurs positives des vitesses en translation (V1 ) de l'origine dudit premier repère (P) donnant naissance à une origine dudit second repère (Ρ').

Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 caractérisée en ce que ladite projection dudit point de commande (CP) projeté en un point de contrôle (CTRLP) de l'espace admissible (MA) est telle que ledit point de contrôle (CTRLP) est positionné a une distance inférieure à une valeur prédéterminée (L) de ladite au moins une droite de séparation (LP).

Méthode de correction d'une trajectoire de déplacement dans un dispositif (DADP) d'aide au déplacement selon la revendication 1 caractérisée en ce qu'elle comprend une détermination d'au moins autant de droites de séparation (LP) que de capteurs (USCAP) présents sur ledit dispositif d'aide au déplacement (DADP).

Produit programme d'ordinateur, caractérisé en ce qu'il comprend des instructions de code de programme pour exécuter les étapes de la méthode selon l'une quelconque des revendications 1 à 7, lorsque ledit programme est exécuté sur un ordinateur.

Description:
METHODE DE CORRECTION AMELIOREE D'UNE TRAJECTOIRE DANS UN DISPOSITIF D'AIDE AU DEPLACEMENT DE PERSONNES EQUIPE DE

CAPTEURS.

1. Domaine de l'invention.

L'invention se rapporte au domaine des équipements d'aide au déplacement de personnes, tels que notamment des dispositifs fauteuils roulants motorisés et dirigeables par un utilisateur à partir d'une interface de contrôle. En particulier, l'invention traite d'une méthode de détermination de paramètres de contrôle de la trajectoire à partir d'informations reçues par des capteurs positionnés sur l'équipement d'aide au déplacement et d'informations de consigne de déplacement émises par un utilisateur de l'équipement via l'interface de contrôle.

2. Etat de l'art. Des équipements de types fauteuils roulants motorisés sont couramment utilisés pour assister des personnes à mobilité réduite dans leurs déplacements. Ces fauteuils sont commandés par leur utilisateur en déplacement dit de « marche avant » ou « marche arrière » et selon une direction de déplacement par rapport à un axe nominal de déplacement (direction vers la gauche ou vers la droite). Les consignes de déplacement en vitesse et en direction sont le plus souvent indiquées par un utilisateur à partir d'une interface de type « manette », par exemple. Des modes de correction de la trajectoire de tels équipements existent pour préciser la trajectoire de déplacement en fonction d'éléments propres à l'environnement, tel que notamment des obstacles. Un mode d'analyse de l'environnement par émission-réception de signaux « ultrasons » a déjà été élaboré mais son usage ne permet pas de faire de la correction de trajectoire d'un véhicule conduit par un individu utilisateur à une vitesse nominale de déplacement. Les applications déjà connues concernent par exemple l'asservissement de robot ou permettent d'éviter une collision lors d'un mouvement effectué en rapport à une commande donnée, indépendant d'une application de transport de personnes.

La demande WO2014/148978A1 intitulée « Control System and method for control of a vehicle in connection with détection of an obstacle » (ANDERSON Jon et Al., SCANIA CV AB ; date de priorité : 19 Mars 2013) décrit un système de contrôle dans un véhicule autonome aux fins d'éviter une collision, et basé sur une réception d'informations en lien avec un obstacle présent dans une trajectoire de déplacement du véhicule.

La demande de brevet JP H07 1 1071 1 A (NIPPON DENSO CO) du 25 avril 1995 décrit un robot adapté à se déplacer et configuré pour éviter les obstacles en fonction notamment de la position et de la distance à l'obstacle.

D'autres systèmes existent et utilisent une technologie mettant en œuvre des télémètres à technologie laser pour évaluer la proximité d'obstacles, mais cette technologie est très onéreuse. Enfin, un système basé sur l'analyse d'images conçues à partir de captures depuis une ou plusieurs caméras existe et permet de définir la position d'un équipement en déplacement dans un environnement intérieur (à l'intérieur de locaux), et permet l'évitement d'obstacles. Celui-ci requiert toutefois l'usage d'au moins une caméra, voire de deux caméras si on souhaite fiabiliser la prise de vues et présente en outre des problèmes de détection de surfaces transparentes.

Les solutions existantes présentes des inconvénients, notamment en termes de complexité de traitement et/ou de coût d'implémentation. 3. Résumé de l'invention.

L'invention permet d'améliorer au moins un des inconvénients de l'état de l'art, en proposant une méthode de correction d'une trajectoire de déplacement dans un dispositif d'aide au déplacement d'au moins une personne, le dispositif d'aide au déplacement étant mû par au moins un moteur et dirigé par un module de contrôle de direction, selon une première vitesse de rotation et une première vitesse de translation (déterminées en fonction d'une ou plusieurs consignes reçues au moyen d'une interface d'entrée), les valeurs de vitesses constituant les coordonnées d'un point de commande dans un repère de déplacement, le dispositif d'aide au déplacement étant équipé d'au moins un dispositif capteur et d'une unité de contrôle, le dispositif capteur étant configuré pour opérer une mesure dans une direction définie par rapport à un axe de déplacement du dispositif d'aide au déplacement, la méthode comprenant :

- une mesure d'une distance entre au moins un capteur ou un point prédéterminé du dispositif d'aide au déplacement et un obstacle présent dans la direction précédemment décrite (ou dans un volume défini autour de cette direction),

- une séparation du repère normé de représentation de couples des valeurs de vitesses de translation et de vitesses de rotation en deux demi-plans par au moins une droite de séparation, l'un des deux demi-plans correspondant à un espace admissible au déplacement, l'autre des deux demi-plans correspondant à une zone d'exclusion au déplacement du dispositif d'aide au déplacement,

- une définition d'une seconde vitesse de rotation et d'une seconde vitesse de translation par projection du point de commande dans l'espace admissible ainsi déterminé, la projection du point de commande définissant alors un « point de contrôle » dans l'espace admissible de déplacement,

- un contrôle du ou des moteurs et du module de contrôle de direction en fonction, respectivement, de la seconde vitesse de translation et de la seconde vitesse de rotation (soit en fonction des coordonnées du point de contrôle défini dans l'espace admissible de déplacement).

Chacun des capteurs présents sur le dispositif d'aide au déplacement de personne est configuré pour délivrer à une unité de contrôle une ou plusieurs informations représentatives d'une distance les séparant d'un obstacle. Selon un mode de réalisation de l'invention, les dispositifs capteurs sont constitués d'un ou plusieurs émetteurs à ultrasons et d'un ou plusieurs récepteurs à ultrasons. Selon une variante, les capteurs peuvent comprendre des éléments d'émission-réception de faisceau laser ou infra-rouge, ou encore des dispositifs caméras qui, couplés par paires, sont adaptés à l'extraction (la génération) d'une information de distance ou représentative d'une distance. La méthode de correction améliorée de trajectoire selon l'invention est utilisable quelle que soit la nature des capteurs utilisés et dès lors que ceux- ci sont adaptés pour délivrer des informations de distances entre des points prédéterminés d'un dispositif d'aide au déplacement de personnes et un ou plusieurs obstacles présents autour du dispositif, lorsque celui-ci est guidé par un utilisateur.

Selon un mode de réalisation préféré de l'invention, l'utilisateur prend place dans le dispositif d'aide au déplacement de personnes. Selon une variante l'utilisateur guide à distance le dispositif d'aide au déplacement de personnes considérant qu'un second utilisateur a pris place dans celui-ci. Dans le cas d'un guidage à distance, les moyens d'entrée des consignes de déplacement comprennent des moyens de communications sans-fil (par exemple des moyens de communication par radiofréquences tels que bien connus dans le domaine des transmissions d'informations sans-fil).

Selon un mode de réalisation de l'invention, la projection du point de commande dans l'espace admissible s'effectue par la détermination d'un point de contrôle appartenant à une droite du repère passant par l'origine du repère et par le point de commande défini par les vitesses en translation et en rotation correspondant à la ou les consignes d'entrée du dispositif.

Selon une variante du mode de réalisation de l'invention la projection du point de commande dans l'espace admissible s'effectue par la détermination d'un point de contrôle appartenant à une droite perpendiculaire à la droite de séparation la plus proche du point de commande précité.

Selon une autre variante du mode de réalisation de l'invention la projection du point de commande dans l'espace admissible s'effectue par la détermination d'un point de contrôle appartenant à une droite horizontale passant par le point de commande. Avantageusement, préalablement ou postérieurement à la projection du point de commande, une étape de gestion de l'inertie mécanique du dispositif d'aide au déplacement comprend une étape de changement de repère du premier repère vers un second repère, le changement de repère comprenant une réduction du premier repère P par le biais d'une diminution homothétique et un décalage vers les valeurs positives des vitesses en translation de l'origine du premier repère donnant naissance à une origine du second repère.

Selon un mode de réalisation de l'invention, la projection du point de commande projeté en un point de contrôle de l'espace admissible est telle que le point de contrôle est positionné à une distance inférieure à une valeur prédéterminée d'au moins une droite de séparation. Cela revient à dire que la projection du point de commande n'est pas positionné strictement sur la droite mais à une distance définie arbitrairement à l'intérieur de l'espace admissible détouré par les droites de séparation, avec cependant une valeur maximale prédéterminée de distance à la ligne la plus proche.

Selon une variante du mode de réalisation de l'invention la correction d'une trajectoire de déplacement dans un dispositif d'aide au déplacement comprend une détermination d'au moins autant de droites de séparation que de capteurs présents sur le dispositif d'aide au déplacement.

4. Liste des figures.

L'invention sera mieux comprise, et d'autres particularités et avantages apparaîtront à la lecture de la description qui va suivre, la description faisant référence aux dessins annexés parmi lesquels :

- la figure 1 représente l'architecture d'un dispositif d'aide au déplacement de personnes selon un mode de réalisation particulier et non limitatif de l'invention. - la figure 2 est une représentation d'un repère normé dans lequel sont définies des vitesses issues de consignes de déplacement et des vitesses déterminées par l'application de tout ou partie de la méthode selon un mode de réalisation particulier et non limitatif de l'invention. - la figure 3 est une représentation d'un repère normé dans lequel sont définies des vitesses issues de consignes de déplacement et des vitesses déterminées par l'application de tout ou partie de la méthode selon une première variante du mode de réalisation de l'invention.

- la figure 4 est une représentation d'un repère normé dans lequel sont définies des vitesses issues de consignes de déplacement et des vitesses déterminées par l'application de tout ou partie de la méthode selon une seconde variante du mode de réalisation de l'invention.

5. Description détaillée de modes de réalisation de l'invention.

Sur la figure 1 , les modules représentés sont des unités fonctionnelles, qui correspondent ou non à des unités physiquement distinguables. Par exemple, ces modules ou certains d'entre eux sont regroupés dans un unique composant. A contrario, selon d'autres modes de réalisation, certains modules sont composés d'entités physiques séparées.

La figure 1 illustre des éléments d'architecture d'un dispositif d'aide au déplacement de personnes selon un mode de réalisation particulier et non limitatif de l'invention. Le dispositif DADP comprend au moins un moteur de propulsion, ou un ensemble de moteurs de propulsion représenté par le module fonctionnel M1 . Selon un premier mode de réalisation, le dispositif DADP comprend également un second moteur M2 permettant de définir la direction de déplacement. Les moteurs de propulsion et de guidage en direction sont respectivement contrôlés par un module de contrôle de vitesse VCTRL et un module de contrôle en direction DCTRL. Selon un second mode de réalisation, le contrôle en direction est effectué en modulant la vitesse de deux moteurs de propulsion respectivement associés à une roue gauche RG et une roue droite RD, de sorte que tout en contrôlant une vitesse moyenne déterminée, une direction de déplacement soit définie par différence entre les vitesses respectives de la roue gauche et de la roue droite, selon un mode différentiel. Les modules de contrôle de vitesse et de direction VCTRL et DCTRL transmettent des signaux de contrôles aux éléments des modules fonctionnels M1 et M2. M1 comprend le ou les moteurs de propulsion et M2 comprend un moteur de guidage en direction, le cas échéant, selon le mode de réalisation.

Les modules VCTRL et DCTRL sont contrôlés par l'unité de contrôle CU qui détermine des signaux VSIG et DISG, définis à partir des informations V3 et u)3. V3 étant définie à partir d'une fusion de vitesses de translation V1 et V2, u)3 étant définie à partir de la fusion de vitesses de rotation ω1 et ω2.

V1 et ω1 représentent respectivement des informations représentatives d'une vitesse en translation et d'une vitesse en rotation reçues par l'unité de contrôle CU selon une consigne utilisateur établie par l'intermédiaire du module CTRL-IN comprenant une manette de contrôle, par exemple.

L'unité de contrôle CU reçoit des informations VCTRL et DCTRL de consignes de vitesse et de déplacement depuis l'interface utilisateur CTRL-IN du dispositif DADP. Les différents traitements opérés par l'unité de contrôle CU sont réalisés notamment à partir des informations produites par un ou plusieurs capteurs USCAP disposés sur le dispositif d'aide au déplacement DADP et par les informations de consignes de déplacement émises par un utilisateur.

Les capteurs USCAP1 et USCAP2 sont des capteurs adaptés à délivrer des signaux représentatifs de l'environnement perçu (dans des directions respectivement prédéfinies par rapport à la direction de déplacement) sur des bus numériques C1 BUS et C2BUS, configurés pour le transfert des informations de distances avec un ou plusieurs obstacles dans une mémoire de traitement de l'unité de contrôle CU .

Tous les modules sont alimentés en énergie par un module accumulateur d'énergie BAT, rechargeable à partir d'une prise secteur. L'unité de contrôle CU comprend des modules CU1 , CU2 et CU3. Le module CU1 est un module de détermination de vitesses de consignes et de vitesses corrigées d'un repère P de référence représentatif de couples de valeur de vitesses de translation et de vitesse de rotation. CU2 est un module de définition d'une vitesse de rotation ω3 et d'une vitesse de translation V3, en fonction des informations reçues par le ou les capteurs (USCAP) et de valeurs de vitesse corrigée par la méthode de correction selon un mode de réalisation de l'invention. CU3 est une unité de contrôle adaptée à contrôler le moteur ou les moteurs (bloc fonctionnel M1 ) de déplacement et le module de contrôle de direction en fonction, respectivement, d'une troisième vitesse de translation V3 et d'une la vitesse de rotation ω3. Selon un mode de réalisation de l'invention, V3 et u)3 sont respectivement égales à V2 et ω2. Selon une variante, V3 et ω3 sont calculées pour tenir compte de l'inertie mécanique propre au dispositif de déplacement de personnes transportant un utilisateur.

Selon un mode de réalisation particulier et non limitatif de l'invention, les modules unités de contrôle cités comprennent l'ensemble des éléments d'architecture classique d'une unité de contrôle, tel qu'un ou plusieurs microcontrôleurs, une ou plusieurs mémoires de travail (mémoire vive) volatiles, une ou plusieurs mémoires de stockage non volatiles, des bus de communication de données, un ou plusieurs circuits tampon (« buffer » en anglais), un circuit de remise à zéro (reset), des circuits d'alimentation électrique et de supervision d'alimentation, un ou plusieurs circuits d'horloge, ainsi que toute autre fonction classiquement utile à la mise en œuvre de fonctions de contrôle. L'architecture de chacun de ces modules n'est pas détaillée plus encore ici, n'étant pas utile à la compréhension de l'invention.

Selon un mode de réalisation particulier et non limitatif de l'invention, l'unité de contrôle CU opère une représentation d'une vitesse en translation et d'une vitesse en rotation telle que définies par le biais de l'interface d'entrée de type manette du dispositif d'aide au déplacement de personnes dans un repère normé

P (ω,ν) dont :

• l'axe des abscisses )S représente des valeurs ) de vitesse de rotation et • l'axe des ordonnées Vs représente des valeurs V (ou V) de vitesse en translation.

Les valeurs de vitesses en translations s'écrivent indifféremment V ou V dans les paragraphes qui suivent. Ainsi, et à titre d'exemple, l'écrite correspond à une valeur discrète V1 de la grandeur V qui représente la valeur instantanée de la vitesse en translation du dispositif DADP.

Les distances mesurées entre les capteurs USCAP1 et USCAP2 permettent la définition de deux droites LP1 et LP2 séparant l'espace global du repère P { ),V) en respectivement deux demi-plans pour chacune de ces droites et définissant de fait, un espace interdit et un espace de déplacement admissible. Des vitesses corrigées sont alors définies dans le repère P { ),V), par projection d'un point de commande CP l'espace interdit en un point de contrôle CTRLP de l'espace admissible précédemment défini dans le repère P (ù),V).

L'utilisation des capteurs USCAP indiquant une distance par rapport à un obstacle permet également de connaître l'orientation de l'obstacle, et notamment, lorsque les capteurs USCAP comprennent une pluralité d'éléments émetteurs et/ou récepteurs ou encore lorsqu'ils sont couplés entre eux de façon à identifier un signal émis par une pluralité de récepteur. Ainsi, et dans le cas d'un mur par exemple, il est possible d'effectuer une mesure en deux ou plus de points de l'obstacle, et de déterminer son orientation dans l'espace.

Selon une variante du mode de réalisation, des limites (lignes droites) verticales et horizontales délimitent l'espace admissible de déplacement en correspondance des limites maximales de consignes en entrée (limites du déplacement souhaité et exprimé par l'intermédiaire de la commande d'entrée au moyen de la « manette » d'interface d'entrée.)

La détermination de la ou des droites de séparation du repère P, lequel correspond à un plan (ω, V), en demi-plans, est réalisée par l'unité de contrôle en fonction notamment des informations représentatives de la distances aux obstacles, transmises par le ou les capteurs USCAP (USCAP1 , USCAP2, ... USCAPn)

Une équation d'une droite de séparation du repère P (dans le plan (ω, V)) est, selon un mode de réalisation préféré de l'invention est :

J v v + Ι ω ω≤ λ (s-s*)

C'est donc une équation d'un demi-plan du repère P participant à la définition de l'espace de déplacement admissible MA dans P, et défini par au moins une mesure d'une distance s à un obstacle, où :

• v est la vitesse instantanée en translation du dispositif DADP, aussi appelée V, · ω est la vitesse instantanée en rotation du dispositif DADP,

• λ est une constante,

• s est la distance mesurée à l'obstacle et

• s * est la distance minimale à l'obstacle, encore appelée position limite du capteur. · J V et J( JO sont des composantes scalaires respectivement définies à

c c

partir des vitesses v e t ω du capteur correspondant dans le repère (ω,ν) :

Où L s est une matrice d'interaction dépendante du capteur (propre au capteur et caractérisée lors d'une phase de conception de celui-ci). T v et Τ ω sont des éléments matriciels permettant de définir les vitesses en c c

translation v et en rotation ω d'un capteur donné du dispositif DADP en fonction des vitesses en translation V et en rotation CU du dispositif complet DADP (par exemple référencé par son centre de gravité).

Les vitesses en translation et en rotation d'un capteur sont définies selon la formule :

T v ©t Τ ω représentent des éléments matriciels propres au dispositif d'aide au déplacement de personnes DADP et caractérisés lors d'une phase de conception de celui-ci.

■ c c

L s est la matrice d'interaction d'un capteur ; et ω sont respectivement les vitesses en translation et en rotation du capteur dans le repère ( ω v )-

La formule suivante caractérise la variation de la distance à un obstacle pour un capteur donné et considérant le déplacement de ce capteur :

r C v " "

s = L s

ù)

Selon un mode de réalisation de l'invention, l'inertie est gérée en mixant la valeur courante déterminée d'une vitesse avec sa valeur précédente. Cette pondération se fait selon un calcul correspondant à l'implémentation d'un filtre passe-bas. Selon un mode de réalisation de l'invention, les déterminations des vitesses en translation et en rotation du dispositif d'aide au déplacement des personnes sont paramétrables, afin de privilégier notamment un déplacement fluide ou un déplacement de nature à mettre en confiance un utilisateur.

La définition des paramètres pourra se faire par tout moyen d'entrée associé à l'unité de contrôle du dispositif DADP, tel que, par exemple, des micro-interrupteurs de configuration, la connexion d'une console adaptée à la configuration, etc. Ainsi, la configuration du comportement du dispositif, par le biais de la correction de trajectoire, est rendue accessible à un personnel formé pour ce faire, tel que par exemple un ergothérapeute, un assistant médical, ou un professionnel de la vente de ce type d'équipement.

Selon un mode de réalisation préféré, et considérant la configuration classique d'un dispositif d'aide au déplacement des personnes au moment de l'invention, le dispositif DADP comprend une quinzaine de capteurs USCAP susceptibles de comprendre chacun un ou plusieurs émetteurs et un ou plusieurs récepteurs.

Selon des variantes, le dispositif peut comprendre un nombre de capteurs inférieur ou supérieur à 15.

V1 , V2, V3 sont des valeurs discrètes de la grandeur vitesse en translation V du dispositif DADP dans le repère v, ω (le repère P), ω1 , u)2, u)3 sont des valeurs discrètes de la grandeur vitesse en rotation ω du dispositif DADP dans le repère v, ω (le repère P).

La figure 2 est une représentation d'un repère normé P dans lequel sont définies des vitesses V1 et ω1 issues de consignes de déplacement et des vitesses V2 et ω2 déterminées par l'application de tout ou partie de la méthode selon un mode de réalisation particulier et non limitatif de l'invention. V1 et ω1 sont définies à partir d'informations (signaux) VCTRL et DCTRL émis par le module interface d'entrée CTRL-IN du dispositif d'aide au déplacement de personnes. V1 représente la vitesse en translation du dispositif DADP sollicitée par la consigne d'entrée et ω1 représente la vitesse en rotation du dispositif DADP sollicitée par la consigne d'entrée. V1 et ω1 sont donc définies à partir de la position d'une manette de commande du dispositif DADP et le couple de valeurs (V1 , ω1 ) constitue les coordonnées d'un point de commande CP dans le repère normé P.

Selon le mode de réalisation préféré de l'invention, une vitesse V1 positive correspond au déplacement en avant du dispositif DADP et une vitesse V1 négative correspond au déplacement en arrière (marche arrière) du dispositif DADP. Selon une convention similaire, une vitesse ω1 positive correspond à un virage à gauche (lorsque V1 est positive) et une vitesse ω1 négative correspond à un virage à droite (lorsque V1 est positive). Une vitesse V1 nulle simultanément à une vitesse ω1 nulle correspond à un immobilisme du dispositif DADP. Le repère P, normé, est défini par les axes u)S et VS, respectivement indicateurs de grandeurs ω de vitesse de rotation et V de vitesse de translation. Chacun des capteurs USCAP1 , USCAP2, USCAPn , constitués d'un ou plusieurs éléments émetteurs et/ou un ou plusieurs éléments récepteurs, délivre à l'unité de contrôle UC du dispositif d'aide au déplacement DADP une information de distance par rapport à un éventuel obstacle présent de la champ de détection autour du dispositif DADP. Avantageusement, lorsqu'un obstacle est détecté, le repère normé P est séparé en deux demi- plans (en fonction notamment de la distance à l'obstacle mesurée) : l'un est interdit en termes de déplacement et l'autre est autorisé en termes de déplacement. Par exemple, le capteur USCAP 1 permet de définir la ligne de séparation LP1 du repère P en utilisant une formule de calcul prédéfinie. L'orientation de la ligne dans le repère normé P dépend (entre autres) de la position et de l'orientation du capteur USCAP1 sur le dispositif d'aide au déplacement DADP. Il en est de même pour le capteur USCAP2 qui, selon le même principe, permet de définir la ligne LP2 de séparation du repère normé P en deux demi-plans. L'un étant autorisé pour le déplacement, l'autre étant interdit. La définition des lignes LP1 , LP2, LPn, qui s'opère de façon dynamique lors du cheminement du dispositif DADP sur un itinéraire théorique défini par l'évolution de la consigne de déplacement (par la manette d'entrée) permet la définition dynamique d'un espace de déplacement dit admissible. Astucieusement, la correction améliorée de trajectoire selon l'invention s'appuie sur la projection du point de commande CP dans l'espace admissible MA de déplacement délimité par une ou une pluralité de droites de séparation LP (LP1 , LP2, ... LPn).

Selon une première variante, la projection du point de commande CP dans l'espace admissible se fait par définition d'un point de contrôle CTRLP appartenant à une droite passant par l'origine du repère P et par le point de commande CP, défini par la consigne d'entrée. Selon une seconde variante, le point de contrôle CTRLP est défini par projection orthogonale du point de commande CP sur la droite LP la plus proche du point de commande CP. Selon une autre variante, une projection horizontale ou sensiblement horizontale du point de commande CP est utilisée pour maintenir au maximum la vitesse en translation du dispositif DADP.

Les vitesses V2 et ω2 correspondant à une trajectoire corrigée sont les coordonnées (valeur de V et valeur de ω) dans l'espace admissible du repère normé P, du point de contrôle CTRLP défini par projection du point de commande CP.

Astucieusement, chacune des variantes permet une meilleure adaptation d'un utilisateur du dispositif DADP d'aide au déplacement de personnes selon son profil pathologique, le cas échéant. La variante utilisée a une incidence directe sur la réactivité, la souplesse et l'assurance ressenties subjectivement par un utilisateur du dispositif DADP. En outre, une gestion de l'inertie est opérée notamment par un décalage des valeurs de vitesse V et ω dans le repère P. Cette translation peut être réalisée par un calibrage et en fonction de caractéristiques propres au dispositif DADP et/ou à un utilisateur de ce dernier. Ainsi, et selon un mode de réalisation particulier de l'invention, une vitesse en translation V3 et une vitesse en rotation ω3 sont définies en vue d'être communiquées aux modules de contrôle VCTRL et DCTRL du dispositif DADP. En l'absence de gestion de l'inertie, ce sont les vitesses V2 et ω2 qui sont transmises sur les bus VSIG et DSIG.

La figure 3 est une représentation d'un repère normé P dans lequel sont définies des vitesses V2 et ω2 par projection du point de commande CP en un point de contrôle PCTRL situé dans l'espace de déplacement admissible et sur une droite perpendiculaire à la droite de séparation la plus proche de CP, selon une variante du mode de réalisation de l'invention.

La figure 4 est une représentation du repère normé P dans lequel sont définies des vitesses V2 et ω2 par projection du point de commande CP en un point de contrôle PCTRL situé dans l'espace de déplacement admissible et sur une droite passant par l'origine du repère P. Cependant, et selon une variante du mode de réalisation de l'invention, la vitesse déterminée V2 et la plus grande vitesse en translation possible dans l'espace de déplacement admissible et inférieure ou égale à la vitesse de consigne V1 du point de commande CP.

Bien évidemment d'autre variantes de définition des vitesses V2 et u)2 sont possibles dans l'espace admissible de déplacement. La détermination de ces vitesses à l'intérieur de l'espace de déplacement ne se limite pas aux seules variantes du mode de réalisation décrites ici.

Avantageusement, l'unité de contrôle UC délivre sur un port de communication, et en vue d'en effectuer un stockage dans une mémoire associée, par exemple, une succession d'informations représentatives des corrections apportées à la trajectoire. L'unité de contrôle UC indique par ce biais la position des capteurs ayant détecté un obstacle (ou une identification du capteur, la distance avec l'obstacle, la position de la consigne au moment de la détection de l'obstacle, etc.) aux fins de réaliser une analyse statistique ou une synthèse de l'aide technique (correction) apportée à l'utilisateur de dispositif DADP. Par ce biais, il est possible d'analyser le comportement d'un utilisateur et de réaliser une adaptation d'un ou plusieurs paramètres de contrôle du dispositif DADP en fonction du comportement observé. Le comportement d'un utilisateur est pratiquement lié à la pathologie et/ou à la nature des traumatismes subis par un utilisateur. Par exemple, un utilisateur sujet à une héminégligence peut ne pas avoir de conscience de tout ce qui correspond à un côté. Il pourra se situer et raisonner quant à des déplacements sur la droite, à titre d'exemple, mais pas sur la gauche. La correction sera donc naturellement plus fréquente lors de déplacements se dirigeant par divergence vers la gauche (puisque c'est le côté non maîtrisé) ou si un obstacle est présent sur le côté gauche par rapport à une trajectoire souhaitable (parce qu'il ne sera pas vu).

Avantageusement, l'implémentation de la méthode de correction de trajectoire selon l'invention permet l'amélioration des trajectoires de déplacement tout en disposant d'une basse complexité calculatoire, d'une architecture basse consommation (ce qui confère une meilleure autonomie au dispositif DADP), d'une grande rapidité d'exécution, d'une latence faible, d'une facilité d'industrialisation.

En outre, l'implémentation de la méthode selon l'invention permet une modularité et une flexibilité nouvelle puisque différents paramétrages possibles rendent le dispositif d'aide au déplacement DADP adaptable au profil d'un utilisateur.

Ainsi, le mode de projection dans l'espace admissible réalisé dépend de ce paramétrage qui est, par exemple, un profil pathologique et/ou psychique d'un utilisateur. L'invention concerne également toute méthode de correction de trajectoire dans un dispositif d'aide au déplacement basée sur une détermination de la présence d'un ou plusieurs obstacles au moyen de capteurs, la méthode déterminant une vitesse de translation et une vitesse de rotation à partir d'une ou plusieurs droites de séparation d'un repère P normé en un espace interdit de déplacement et un espace de déplacement admissible, lequel repère est une référence représentative de l'environnement perçu dans une direction de déplacement, les vitesses ainsi déterminées étant utilisées respectivement fusionnées avec des consignes de vitesse et de direction saisies par un utilisateur du dispositif d'aide au déplacement au moyen d'une interface utilisateur adaptée à le contrôler. L'invention concerne également tout dispositif d'aide au déplacement mettant en œuvre une telle méthode. Enfin, l'invention concerne tout produit programme d'ordinateur mettant en œuvre les étapes de la méthode selon un mode de réalisation particulier et non limitatif de l'invention. L'invention concerne ainsi toute méthode de correction de trajectoire dans un dispositif d'aide au déplacement basée sur une mesure de distance entre au moins un capteur USCAP et un obstacle, une séparation d'un repère P de représentation de couples Cv-ΐωΐ de valeurs de vitesses de translation V1 et de vitesses de rotation ω1 en deux demi-plans, par au moins une limite de séparation LP d'un repère P normé, en une zone d'exclusion et un espace admissible MA de déplacement, éventuellement délimité en outre par des limites de consigne en entrée, une définition d'une seconde vitesse de rotation u)2 et d'une seconde vitesse de translation V2 par projection d'un point de commande CP dans l'espace admissible MA délimité du repère normé P.