Brevet FR2554599A1 — publié le 19850510

PROCEDE ET DISPOSITIF DE MESURE PAR ULTRASONS DE LA VITESSE D'AVANCEMENT D'UN VEHICULE PAR RAPPORT AU SOL La présente invention se rapporte à un procédé de mesure de la vitesse d'un véhicule par ultrasons et son application à la mesure du patinage des roues d'un tel véhicule, ainsi qu'à un dispositif pour la mise en oeuvre de ce procédé. La vitesse d'avancement d'un véhicule peut se déduire de celle des roues de ce véhicule lorsqu'il y a roule- ment sans glissement, mais tel n'est plus le cas en présence d'un patinage des roues. On rencontre notam- ment ce problème sur les tracteurs agricoles dont il faut connaître la vitesse d'avancement par rapport au sol, soit pour assurer un épandage précis d'une quan- tité de matière par unité de surface, soit pour en déduire le taux de patinage des roues afin d'optimiser la vitesse du tracteur et/ou la profondeur de labour. Le brevet FR-A- 2 354 565 décrit un dispositif de mesure par ultrasons de la vitesse d'avancement d'un véhicule par rapport au sol comprenant un émetteur et un récepteur de signaux ultrasons ainsi qu'un circuit de mise en forme et de traitement de ces signaux pro- duisant un signal Doppler représentatif de ladite vitesse. Malheureusement, en pratique l'information ainsi obte- nue sur la vitesse du véhicule n'est pas réellement fiable car le signal Doppler est fortement affecté par les variations de la célérité du son en fonction de la température de l'air et des coefficients de réflexion et de diffusion du sol dues aux irrégularités et modi- fications de la nature du terrain rencontré. - 2 - La présente invention vise à fournir un procédé de mesure par ultrasons de la vitesse d'avancement d'un véhicule par rapport au sol qui permette de s'affran- chir des erreurs systématiques et aléatoires rencon- trées avec le dispositif du brevet précité. A cet effet, l'invention a pour objet un procédé de mesure par effet Doppler de la vitesse d'avancement d'un véhicule par rapport au sol suivant lequel on émet vers le sol un signal de fréquence ultrasonique, on détecte le signal réfléchi du sol vers le véhicule, on engendre un signal produit du signal émis par le signal reçu et on filtre ledit signal produit pour en extraire la fréquence fondamentale constituant un signal Doppler représentatif de la vitesse d'avance- ment du véhicule par rapport au sol, caractérisé en ce qu'on effectue en outre successivement un filtrage médian et une moyenne exponentielle du signal Doppler. Suivant une caractéristique de l'invention, on effec- tue en outre sur le signal Doppler filtré une correc- tion en fonction de la température de l'air ambiant. L'invention a également pour objet un dispositif pour la mise en oeuvre du procédé défini ci-dessus compre- nant un générateur de signal à fréquence ultrasonique connecté à des moyens d'émission d'un signal ultra- sonique vers le sol, des moyens de réception et d'am- plification du signal réfléchi du sol vers le véhicule, des moyens de détection engendrant ledit signal pro- duit du signal émis par le signal reçu, et des moyens de filtrage pour extraire le signal Doppler dudit signal produit, caractérisé en ce qu'il comprend en 43 1i 1 676 - 3 - outre un capteur de température de l'air ambiant con- necté à un circuiL logique de traitement comportant un microprocesseur assurant le filtrage médian, la moyenne exponentielle et la correction en température du signal Doppler. D'autres caractéristiques et avantages de l'invention ressortiront de la description qui va suivre d'un exemple de sa réalisation donné. uniquement à titre d'exemple et illustré par les dessins annexés sur les- quels: - - la figure 1 est un schéma bloc général d'un disposi- tif de mesure de vitesse et du patinage des roues d'un véhicule suivant l'invention; - la figure 2 est un schéma bloc du circuit logique de traitement des données du dispositif représenté à la figure 1 - la figure 3 est un organigramme du programme princi- pal de fonctionnement du circuit de la figure 2; et - la figure 4 est un organigramme d'un programme d'in- terruption associé au programme principal de la figure 3. En se reportant à la figure 1, le dispositif de mesure de la vitesse et du patinage des roues d'un véhicule comprend un circuit logique de traitement 1 connecté d'une part à un module d'affichage 2 et d'autre part à un certain nombre de transducteurs lui fournissant des informations relatives à la vitesse des roues du véhi- cule, à la température de l'air ambiant et à la vitesse du véhicule par rapport au sol sous forme d'un signal Doppler. 49398 I 1676 - 4- Le signal Doppler est obtenu par multiplication dans un circuit de détection 3 des signaux de fréquence ultrasonique émis vers le sol par un émetteur 4 et reçu après réflexion par un récepteur 5. L'émetteur 4 est alimenté à partir d'un oscillateur du circuit de traitement 1 dont le signal est amplifié par un ampli- ficateur 6 tandis que le signal de sortie du récepteur est amplifié par un amplificateur 7 avant applica- tion au circuit de détection 3, qui reçoit par ail- leurs également le signal émis par l'oscillateur. Le signal Doppler généré par le circuit de détection 3 est appliqué au circuit logique de traitement 1 après filtrage en 8. Le circuit de détection 3 est de préférence constitué par un multiplieur analogique XR 2208 précédé d'un écrêteur à diodes Zener permettant de s'affranchir des nombreuses variations d'amplitude que subit le signal ultrasonore reçu et d'attaquer le multiplieur analo- gique avec des signaux d'amplitude constante pour le faire fonctionner en détecteur de phase. Le circuit de détection 3 produit donc un signal contenant le signal Doppler et des harmoniques de la porteuse, puisque le multiplieur a effectué le produit de deux fonctions sinusofdales légèrement décalées en fréquence. Le circuit 8 est un filtre passe-bande dont la bande passante est choisie de façon à ne pas altérer le signal Doppler tout en assurant une bonne réfection de la porteuse et des très basses fréquences qui pour- raient apparaître par suite de vibrations mécaniques. L'information relative à la vitesse des roues est four- nie au circuit 1 par un capteur 9 disposé, par exemple, en sortie de la boite de vitesses du véhicule et dont le signal de sortie est mis en forme en 10. -5- Enfin, l'information relative à la température de l'air ambiant est fournie au circuit 1 par une ther- mistance ou autre capteur de température approprié 11 et un circuit de mise en forme 12. Le circuit logique de traitement 1 est représenté plus en détail à la figure 2 et comprend un microprocesseur 13, une mémoire morte 14 contenant le programme de fonctionnement du microprocesseur 13, une mémoire vive 15 pour le stockage de résultats intermédiaires, deux circuits de temporisation 16 et 17 assurant la mesure de la vitesse des roues et d'avancement par rapport au sol du véhicule, un convertisseur analogique-numérique 18 pour la lecture de la température provenant du cap- teur 11, un port de sortie 19 qui pilote le module d'affichage 2 et un décodeur 20 qui assure la valida- tion des circuits 14, 15, 16, 17, 18 et 19 par leur entrée CS. Le microprocesseur 13 est connecté par un bus de données 21 aux circuits 14, 15, 16, 17, 18 et 19 et par un bus d'adresses 22 aux mémoires 14 et 15 et au décodeur 20. A titre d'exemple, on peut utiliser pour les diffé- rents circuits de la figure 2 les composants suivants: - microprocesseur 13: CPU 6809 - mémoire morte 14: EPROM 2716 - mémoire vive 15: RAM 2016 circuits de temporisation 16 et 17: "timers" 6840 - convertisseur analogique/numérique: ADC 804 - port de sortie: PIA 6821 49398 116 -6- Les circuits de temporisation 16 et 17 sont de type programmable et interrompent le fonctionnement du microprocesseur 13 par son entrée IRQ pour lui per- mettre d'aller lire leur contenu et de traiter cette information. Le circuit de temporisation 16 comporte trois compteurs 161, 162 et 163 programmés respectivement en monos- table, en comparateur de fréquence et en oscillateur. Le compteur 163 génère une fréquence de, par exemple 36 kHz, qui est appliquée à l'amplificateur 6, au cir- cuit de détection 3, ainsi qu'aux entrées d'horloge CK1 et CK2 des compteurs 161 et 162 respectivement. Le signal Doppler en provenance du filtre 8 est appli- qué, par l'intermédiaire d'une bascule de Schmitt 23 assurant une dernière mise en forme, aux entrées "gate" G1 et G2 des compteurs 161 et 162 respectivement. Le compteur 162 génère une interruption IRQ à chaque front descendant sur son entrée G2, ce qui provoque la lecture de son contenu. La valeur lue est alors repre- sentative de la période du signal Doppler: ce compteur 162 assure donc une mesure de période. La lecture de la période s'effectuant à chaque inter- ruption IRQ, c'est la dernière valeur lue qui resterait en principe affichée en cas de cessation du signal Doppler. Pour pallier cet inconvénient, le compteur 161 programmé en monostable est réinitialisé à chaque front descendant sur son entrée G1: il envoie ainsi une interruption IRQ qui provoque la remise à zéro de l'affichage à chaque fois que la fréquence Doppler reste inférieure à une valeur donnée, par exemple 1lHz. 49398 I 161 - 7- Le circuit de temporisation 17 comporte également trois compteurs 171, 172 et 173 qui sont utilisés pour la mesure du patinage. Le patinage des roues du véhicule est exprimé par la relation: Patinage = 100 Vr - Vd, dans laquelle: Vr - Vr est la vitesse périphérique des roues du véhi- cule; Vd est la vitesse d'avancement du véhicule par rapport au sol mesurée par effet Doppler. Or, Vd= Kd. fd et Vr= Kr. fr, Kd et Kr étant des constantes et fd et fr les fré- quences des signaux Doppler et de vitesse roues respec- tivement. Kd fd On a donc: Patinage = 100 - 100 Kr fd Kd Le rapport KL étant égal à une constante, on constate Kr fd que le patinage ne dépend que du rapport f. C'est ainsi que dans le préseet exemple de réalisation on a: fd = 1,5 KHz a 36 km/h d'o Kd fd = 36 fr = 1,5 KHz à 25 km/h d'o Kr fr = 25 Kd soit: K; = 1,4 On en déduit: Patinage = 100 - fd = 100 f/2 (1 fr = fr/2 35 Le circuit de temporisation 17 permet de mesurer le patinage par application de l'expression {1), étant entendu que les valeurs numériques données ci-dessus ne doivent être considérées que comme un exemple nul- lement limitatif de la portée de l'invention. A cet effet, le microprocesseur 13, qui a lu la période Doppler mesurée par le circuit de temporisation 16, commande le compteur 173 pour qu'il génère une fré- quence 2fd égale à la fréquence Doppler multipliée par deux et filtrée. Le compteur 171 reçoit à son entrée d'horloge CK1 le signal fr de vitesse des roues en provenance du cap- fr teur 9 et le divise par 35. Le signal -- ainsi obtenu est appliqué par le compteur 171 à l'entrée "gate" G2 du compteur 172 qui reçoit sur son entrée d'horloge CK2 le signal 2fd de fréquence double du signal Doppler. A chaque front descendant de ce signal, le compteur 172, qui est programmé en comparateur de fréquence, envoie au microprocesseur 13 une interruption IRQ qui provoque la lecture de son contenu dont la valeur est égale à: 2fd Vd PAT = fr72 = 100 Vr Le microprocesseur 13 calcule et commande l'affichage de la valeur du patinage (Patinage = 100 - PAT) ainsi que de la vitesse du véhicule par rapport au sol sui- vant le programme principal et le programme d'inter- ruption des figures 3 et 4 qui seront maintenant décrits. 4fl 1 "I - 9- En se reportant à la figure 3, le démarrage du pro- gramme principal (étape 30) est suivi d'une étape 31 d'initialisation des registres, mémoires vives, variables, ports, etc., d'une étape 32 de lecture de température, d'une étape 33 de correction en tempéra- ture, d'une étape 34 de recréation du signal Doppler filtré, d'une étape 35 de calcul de la vitesse Vd d'avancement du véhicule, d'une étape 36 d'affichage de la vitesse Vd d'avancement du véhicule, d'une étape 37 de calcul du patinage, d'une étape 38 d'affi- chage de la valeur du patinage et d'une étape 39 d'at- tente d'interruption. A la première passe du programme principal, la période Doppler T et le patinage ont bien étendu une valeur nulle en raison de l'initialisation opérée à l'étape 31. A l'étape 39, le programme principal est en attente d'interruption pour passer au programme d'interruption illustré par la figure 4. Le programme d'interruption se sépare en trois branches: - on passe dans la branche B1, lorsque l'interruption IRQ vient du monostable 161, pour la remise à zéro de l'affichage; - on passe dans la branche B2 lorsque l'interruption IRQ vient du compteur 162: le microprocesseur lit alors la période Doppler T présente dans le compteur 162 et effectue un filtrage qui sera décrit ci-après - on passe dans la branche B3 lorsque l'interruption IRQ provient du circuit de temporisation 17: il y a alors lecture du contenu du compteur 172, à savoir 49398 Il 1 - 10 - PAT = 100 Vd Vr On supposera maintenant que l'on passe de l'étape 39 du programme principal à la branche B2 du programme d'interruption qui constitue une phase importante de la mise en oeuvre du procédé suivant l'invention. Cette branche assure en effet le traitement du signal Doppler qui, au sortir du filtre passe-bande 8, n'est pas exploitable directement pour les raisons évoquées précédemment. En effet, pour une vitesse d'avance stabilisée, le signal Doppler présente une modulation d'amplitude qui occasionne la perte du signal pendant un certain temps. Bien que le signal soit mis en forme, il est nécessaire de fixer un seuil de détection, afin de ne pas être sensible aux vibrations du véhicule. Le dispositif de mesure doit donc être capable de rejeter les informa- tions erronées rencontrées par la mesure de période. Par ailleurs, la fréquence recueillie n'étant pas fixe, elle non plus, il est nécessaire de filtrer la mesure de période Doppler effectuée. La répartition de cette fréquence dépend directement du diagramme de rayonne- ment de la cellule ultrasonore dont l'angle d'ouver- ture des cornets de directivité doit être choisi de manière appropriée. La modulation de fréquence ainsi que la modulation d'amplitude du signal Doppler font donc que la mesure de période effectuée doit passer par un certain nombre de filtres. La perte d'impulsions due à la modulation d'amplitude se traduit par une augmentation brutale de la période 493U1 1 67 - 11 - mesurée. Le pic correspondant ne se traduit générale- ment que par une seule valeur erronée qu'il convient de supprimer. C'est ainsi que, après la lecture de la période Dop- pler dans le compteur 162 (étape 40) et la réinitiali- sation de ce dernier (étape 41), on opère à l'étape 42 un filtrage médian sur trois valeurs qui se traduit par l'élimination des deux valeurs extrêmes d'une série de trois valeurs prises consécutivement dans le temps. La modulation de fréquence se traduit par une incerti- tude sur la période mesurée et par une fluctuation constante autour d'une valeur moyenne. Afin d'éliminer ce défaut, on effectue à l'étape 43 une moyenne expo- nentielle (filtrage numérique du premier ordre): Tn + t n + (l l) T n Tn O T n +1 est la nouvelle période Doppler calculée, t n + 1 est la période Doppler issue du filtrage médian, T est l'ancienne période Doppler calculée, n K est la constante de temps de ce filtre. Avec une valeur pour K égale à 6, la valeur calculée est relativement stable et le retard entre la vitesse réelle et la vitesse mesurée pour un échelon autour de km/h est inférieur à une seconde. A l'issu de ces deux filtrages, on obtient une période Doppler à laquelle on doit faire subir une correction en température, afin d'en déduire la vitesse réelle Vd d'avancement du véhicule. Pour ce faire, l'étape 44 49398 1 1676 - 12 - ramène au programme principal o, à l'étape 32, on lit la valeur de la température ambiante Tp sur le conver- tisseur analogique/numérique 18.A l'étape suivante 33, on effectue la correction en température conformément à l'expression: - T corrigée = T n + 1 (1 0) dans laquelle - T n + 1 est la période Doppler filtrée calculée à n+ l'étape 43, - Tp est la température ambiante. Cette expression matérialise le fait que la vitesse de propagation des ultrasons varie de 1 % tous les 5 C. A l'étape 34, on recrée un signal de fréquence double du signal Doppler filtré et corrigé en température par commande du circuit de temporisation 17 comme indiqué précédemment. On calcule ensuite à l'étape 35 la vitesse réelle d'avancement du véhicule par rapport au sol. Sachant Vd que la fréquence Doppler est fd = 2 Vd fe sin 0 o - Vd est la vitesse du véhicule mesurée par effet Doppler, - C est la célérité du son, - 0 est l'angle d'inclinaison des cornets de directi- vité, - fe est la fréquence d'émission, - 13 - fd x C on a: Vd = 2fe.sin 0 soit Vd = soit V 2.Td.fe.sin 0 On affiche ensuite la vitesse calculée du véhicule Vd (étape 36), puis on calcule le patinage à l'étape suivante. La valeur PAT ayant été lue précédemment dans le compteur 172 lors d'une interruption générée par ce dernier, puis mémorisée, le microprocesseur 13 effectue simplement le calcul 100 - PAT (étape 37) puis affiche la valeur du patinage ainsi obtenue (étape 38). Le programme principal reste ensuite en phase d'at- tente jusqu'à l'apparition d'une nouvelle interruption IRQ qui initialise le déroulement du programme d'in- terruption suivant l'une des branches B1, B2 ou B3. On constate que, par un traitement adéquat, il est possible d'utiliser le signal Doppler malgré les fluc- tuations en amplitude et en fréquence qu'il présente. On notera d'autre part que, dans l'exemple décrit, le patinage n'est pas calculé par programme afin de ne pas augmenter le temps de calcul: le circuit de tem- porisation programmable 17 est commandé par le micro- processeur 13 pour recréer une fréquence double de la fréquence Doppler filtrée et assure alors une compa- raison entre la vitesse réelle du véhicule et la vitesse des roues. De cette façon, les informations vitesse réelle et patinage sont aussi voisines que possible de la réalité pendant les états transitoires. Cependant, en variante, ce calcul peut être effectué directement par programme dans le microprocesseur sans sortir du cadre de l'invention. 49398 il 1 - 14- REVENDICATIONS 1. Procédé de mesure par effet Doppler de la vitesse d'avancement d'un véhicule par rapport au sol suivant lequel on émet vers le sol un signal de fréquence ul- trasonique, on détecte le signal réfléchi du sol vers le véhicule, on engendre un signal produit du signal émis par le signal reçu et on filtre ledit signal pro- duit pour en extraire la fréquence fondamentale cons- tituant un signal Doppler représentatif de la vitesse d'avancement du véhicule par rapport au sol, caracté- risé en ce qu'on effectue en outre successivement un filtrage médian et une moyenne exponentielle du signal Doppler. 2. Procédé suivant la revendication 1, caractérisé en ce que le filtrage médian consiste à éliminer les deux valeurs extrêmes d'une série de trois valeurs du signal Doppler prises consécutivement dans le temps. 3. Procédé suivant l'une quelconque des revendications 1 et 2, caractérisé en ce que la moyenne exponentielle consiste en un filtrage numérique du premier ordre de la forme: T n +î1 =t___ O la forme: T = n + 1 + (1 - -) T o n K K n - Tn + est la nouvelle période calculée du signal Doppler, - tn + 1 est la période du signal Doppler issu du filtrage médian, -Tn est la période du signal Doppler calculée précé- demment, - K est la constante de temps de filtrage. 4939 I 1676 - 15 - 4. Procédé suivant l'une quelconque des revendications 1 à 3, caractérisé en ce qu'on effectue en outre sur le signal Doppler filtré une correction en fonction de la température de l'air ambiant. 5. Procédé suivant la revendication 4, caractérisé en ce que ladite correction en fonction de la température est de la forme: T =T (1 le)o corrigée n + 1 ( 500 - Tp est la valeur de la température ambiante; - T n + 1 est la période du signal Doppler filtré - T corrige est la valeur corrigée en fonction de la c:orrigée température de la période du signal Doppler filtré. 6. Dispositif pour la mise en oeuvre du procédé sui- vant l'une quelconque des revendications 1 à 5, com- prenant un générateur (163) de signal à fréquence ultrasonique connecté à des moyens (6, 4) d'émission d'un signal ultrasonique vers le sol, des moyens de réception (5) et d'amplification (7) du signal réflé- chi du sol vers le véhicule, des moyens de détection f3) engendrant ledit signal produit du signal émis par le signal reçu, et des moyens de filtrage (8) pour extraire le signal Doppler dudit signal produit, caractérisé en ce qu'il comprend en outre un capteur de température de l'air ambiant (11) connecté à un circuit logique de traitement (1) comportant un micro- processeur (13) assurant le filtrage médian, la moyenne exponentielle et la correction en temperature du signal Doppler. - 16 - 7. Dispositif selon la revendication 6, caractérisé en ce que le circuit logique de traitement (1) comporte un premier circuit de temporisation (16) programmable comprenant un premier compteur (163) constituant ledit générateur de signal à fréquence ultrasonique et un second compteur {162) recevant le signal à fréquence ultrasonique et le signal Doppler et dont le contenu, représentatif de la période (T) du signal Doppler, est lu par le microprocesseur (13) à chaque front descen- dant du signal Doppler. 8. Dispositif selon la revendication 7, caractérisé en ce que le circuit logique de traitement (1) comprend un module {2) d'affichage de la vitesse d'avancement du véhicule et le premier circuit de temporisation (16) comporte un troisième compteur {161) recevant le signal Doppler et le signal de fréquence ultrasonique et com- mandant la remise à zéro de l'affichage par le micro- processeur (13) lorsque la fréquence du signal Doppler reste inférieure à une valeur donnée. 9. Dispositif selon la revendication 8, caractérisé en ce qu'il comprend des moyens {9, 10) de mesure de la vitesse (Vr) des roues du véhicule et un second circuit de temporisation (17) pour la mesure du patinage des roues du véhicule comportant un premier compteur (173) commandé par le microprocesseur (13) pour engendrer un signal de fréquence multiple de la fréquence du signal Doppler filtré et corrigé en température, un deuxième compteur (171) recevant le signal de vitesse roue (Vr) et générant un signal dont la fréquence est une frac- tion de celle du signal de vitesse roue (Vr), et un troisième compteur {162) recevant les signaux émis par les premier et second compteurs et dont le contenu (PAT) lu périodiquement par le microprocesseur (13) est égalà une constante près au patinage des roues du véhicule. 1;i S