ES2552711A1 - Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado - Google Patents
Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado Download PDFInfo
- Publication number
- ES2552711A1 ES2552711A1 ES201430808A ES201430808A ES2552711A1 ES 2552711 A1 ES2552711 A1 ES 2552711A1 ES 201430808 A ES201430808 A ES 201430808A ES 201430808 A ES201430808 A ES 201430808A ES 2552711 A1 ES2552711 A1 ES 2552711A1
- Authority
- ES
- Spain
- Prior art keywords
- mobile
- series
- yen
- trajectory
- circuit
- 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.)
- Granted
Links
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04Q—SELECTING
- H04Q1/00—Details of selecting apparatus or arrangements
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Mobile Radio Communication Systems (AREA)
Abstract
Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado. El procedimiento, en el caso más completo, comprende las etapas de: a) Generar una serie de parámetros característicos de cada tramo de la trayectoria durante un recorrido de reconocimiento del móvil. b) Caracterizar la trayectoria mediante autocorrelación de desfase variable de la serie de parámetros característicos, obteniendo su periodicidad. Siendo el número de tramos del circuito N coincidente con la distancia entre dos máximos consecutivos de la función autocorrelación C(k). c) Localizar la posición del móvil sobre la trayectoria mediante correlación de desfase variable de la trayectoria obtenida en la etapa b), con el movimiento del móvil sobre la misma. d) Controlar automáticamente la velocidad del móvil en función de los parámetros obtenidos para cada tramo. El equipo que ejecuta el procedimiento anterior, comprende un dispositivo de medida y control (DMC) incorporado al móvil, y un mando electrónico para el piloto (MEP) conectado con el dispositivo anterior vía radio.
Description
La presente invención se refiere a un procedimiento de caracterización de una trayectoria cerrada sobre carril, rail, o cable guía, desconocida previamente, pero recorrida por un móvil controlado digitalmente, sin la utilización de sensores externos al móvil, ni recepción de señales externas de ningún tipo.
Esta invención es aplicable a vehículos eléctricos a escala de control digital, tales como los vehículos a escala de carreras (slots), trenes eléctricos y similares, que es donde ha sido validada, pero también a dispositivos de conducción automática en tamaño real, tales como vagones de metro, almacenes automatizados, y en general en cualquier vehículo en el que se precise reconocer una trayectoria repetitiva y controlar automáticamente la marcha sobre la misma. Su campo de aplicación es el de los sistemas de control de vehículos.
Son conocidos numerosos sistemas de ayuda a la conducción de diversos vehículos de transporte, como tranvías, trenes, vagones de metro etc. que presentan una trayectoria repetitiva. Habitualmente se utilizan sistemas complejos que suelen recurrir al empleo de balizas externas que transmiten al vehículo la información de su posición, asi como a la utilización de dispositivos GPS embarcados. En general se trata de dispositivos caros y complejos con un elevado riesgo de error debido a la multiplicidad de elementos.
También se conocen unos juguetes constituidos por vehículos eléctricos a escala dotados de movimiento guiado por unas pistas o vías, siendo los más conocidos los vehículos de carreras (slots) y los trenes eléctricos
Estas pistas o vías comprenden un par de tiras metálicas o electrodos continuos paralelos en los que hacen contacto unas escobillas o partes del vehículo para tomar dinámicamente la necesaria energía eléctrica, energía que acciona un motor de corriente continua equipado en el vehículo, y en algunos casos la iluminación en el propio vehículo.
En el caso de vehículos de slots se disponen varias pistas en paralelo para permitir adelantamientos, traccionando las ruedas de los vehículos por un soporte de las pistas que
simula una carretera o circuito de carreras, usualmente constituido por piezas montables
entre sí
Cada pista en este caso comprende una ranura flanqueada por ambos electrodos, ranura por la que se inserta y desliza una guía del vehículo provista de las escobillas
Tradicionalmente la variación de la velocidad se ha conseguido variando, mediante un reostato manejado por el usuario, la tensión de alimentación suministrada al motor del vehículo
Por esta razón se necesita una pista por cada vehículo, lo que perjudica la competitividad al tener las pistas morfologías diferentes (interior o exterior, peraltes, etc)
Modernamente se ha solventado este problema mediante el control digital
Este control se basa en incorporar en cada vehículo un circuito decodificador/ regulador capaz de leer unas señales de control individualizadas que se inyectan mediante modulación de pulsos en la alimentación suministrada a los vehículos a través de los electrodos de las pistas, alimentación que en este caso pasa a ser contínua e igual a la nominal de los motores, y común para todas las pistas y vehículos
La parte decodificadora del circuito de cada vehículo interpreta los comandos dirigidos al mismo (nivel de velocidad, encender o apagar la iluminación) y la parte reguladora los ejecuta, bien regulando la tensión que llega al motor o conmutando la iluminación
La individualización de las señales de control se realiza integrando en los comandos un código único por vehículo, de modo que, de todos los comandos para todos los vehículos inyectados en los electrodos de las pistas, cada vehículo es capaz de discriminar los suyos
Esto permite la circulación de todos los vehículos por todas las pistas, pudiendo elegir el trazado más favorable y permitiendo los cambios de pista para adelantamientos mediante dispositivos electromecánicos adecuados de cambio de pista
La alimentación y señales de control son suministradas desde una consola de control microprocesada a la que se conectan los mandos que manejan los usuarios
Los dispositivos electromecánicos de cambio de pista son iguales a los tradicionales cambios de vía o aguja de los trenes eléctricos y se activan en el sentido adecuado al paso de cada vehículo según las órdenes que el usuario da a través de su mando, y que son
adecuadamente procesadas y transformadas en comandos por el control digital,
concretamente en la consola
El control digital comprende también la implantación de un sistema de localización de los vehículos para sincronizar determinados eventos, como la selección en un sentido u otro de un cambio de vía o pista para el mismo o la captura de un tiempo (cronometraje), con el paso de un vehículo concreto y no con otro
En slots este sistema de localización se viene materializando mediante una red de sensores convenientemente distribuidos a lo largo del recorrido
Cuando un usuario genera un comando para su vehículo que requiere una sincronización externa, por ejemplo un cambio de pista, el vehículo recibe el comando y emite una señal que, al paso por un sensor cualquiera es recogida por éste localizando al vehículo, y sirve al control para sincronizar la acción correspondiente, por ejemplo la activación del cambio de vía para ese vehículo sin afectar a los otros
La implementación de estos sensores actualmente se basa en sistemas mecánicos y magnetomecánicos, donde un imán es activado por un sistema mecánico accionado al paso del vehículo; o también por sistemas ópticos, donde un fotodiodo detecta el haz emitido por otro fotodiodo emisor provisto en el vehículo; o por sistemas electrónicos mediante la variación por derivación en paralelo de resistencias óhmicas distribuidas por las pistas, con una resistencia montada en el vehículo.
En el primero de los casos se tienen pérdidas considerables de potencia tanto por rozamientos mecánicos como por los campos magnéticos. En el segundo se producen errores por suciedad en los fotodiodos o por condiciones de iluminación inadecuadas, y en el tercero se precisa igualmente dotar de sensores en pista al circuito para detectar el paso del vehículo. Todos ellos presentan dos importantes inconvenientes: la incertidumbre de la posición de los vehículos en el circuito hasta que pasan por un punto de detección o sensor en pista, y la necesidad de dotar al circuito de elementos adicionales que con el paso del tiempo y del uso se deterioran. Adicionalmente, cuando un vehículo se sale de la pista, el sistema pierde su posición, hasta que no vuelva a pasar por el próximo sensor.
En el caso de que este tipo de instalaciones de slot se utilicen para competición, los conductores tienen que entrenar previamente sin tener una referencia fiable de cuales pueden ser los tiempos de referencia mínimos a alcanzar por vuelta, salvo que se disponga de datos históricos que tampoco son fiables al referirse a distintos repartos del peso entre ejes, composición de las gomas de las ruedas y otras características de los distintos
vehículos. La utilización de simuladores como se hace en carreras de formula 1 queda
excluida por coste, complejidad y numero de instalaciones fijas existentes.
En consecuencia, es un objetivo de la presente invención el disponer de un dispositivo que ejecute un procedimiento que permita caracterizar la trayectoria repetitiva del móvil, sin utilización de ayudas externas.
Es otro objetivo de la presente invención el disponer de un dispositivo que ejecute un procedimiento de autolocalizacion del móvil sobre la trayectoria previamente caracterizada, sin apoyos externos.
y finalmente, es otro objetivo de la presente invención el poder, una vez caracterizada la trayectoria y autolocalizado el móvil, realizar la conducción automática del mismo en función de las características que se deseen; bien obtener la máxima velocidad media y tiempo mínimo por vuelta, bien asegurar un control de seguridad que impida que el móvil abandone su trayectoria encarrilada.
Para alcanzar los objetivos propuestos se ha concebido el procedimiento y dispositivo de la invención, que tiene una constitución óptima para implementar una autolocalización efectiva de los móviles controlados digitalmente sobre una trayectoria cerrada y encarrilada a lo largo del recorrido que efectúan.
El fundamento de la invención consiste en incorporar dentro del móvil un giróscopo, un sensor de tensión de pista y un dispositivo electrónico microprocesado en serie con el motor del coche. En función de los datos recibidos del giróscopo y del sensor de tensión de pista es capaz de reconocer y memorizar los parámetros característicos del trazado del circuito y conocer en todo momento cual es su posición en el mismo. Lo novedoso de este sistema es que el móvil es capaz de saber su posición en la pista sin necesidad de sensores o balizas externos como utilizan los sistemas actuales. Además, el posicionamiento lo realiza con precisión suficiente como para permitir la conducción automática, es decir, sin pilotaje ni ayuda externa, controlando la velocidad del motor y los puntos de frenada idóneos, identificando la posición de cambios de carril y entrada en las vías de servicio si los hubiera. Para ello, además de los sensores y de la electrónica microprocesada, se le dota de un programa adecuado grabado en memoria no volátil que ejecuta una serie de algoritmos que se explican más adelante.
Se puede dotar al sistema de una red de radio que permita intercambiar información entre los móviles y los pilotos mediante una centralita de control que reciba de forma continua y precisa información de la posición de los vehículos, ya sean pilotados o no. Esto permite enviar a los móviles órdenes de ejecución inmediata como paradas, limitación de velocidad y también parámetros que definan la forma de conducción de cada tramo, tales como aceleración y velocidad máxima. Esta información puede tener una parte pública y otra privada ya que, por ejemplo, los datos de puntos de frenado, velocidad de paso por curva etc conseguidos en entrenamientos de carreras de slot no es conveniente que sean conocidos por los competidores.
En circuitos con cruces de pistas se podrá programar la elección de trazado y cambios de carril. Al conocer la posición de los vehículos la centralita puede ejecutar algoritmos que eviten la colisión de los vehículos en puntos conflictivos.
La invención es, por tanto, un conjunto de sensores, electrónica microprocesada y programa que realiza las siguientes funciones:
a) Generar una serie de parámetros característicos de cada tramo de la trayectoria durante un recorrido de reconocimiento repetitivo del móvil, guardando dichos parámetros para permitir al vehículo posteriormente saber su posición en el circuito con precisión.
b) Caracterizar la trayectoria mediante autocorrelación de desfase variable de la serie de parámetros característicos, obteniendo su periodicidad.
c) Localizar la posición del móvil sobre la trayectoria mediante correlación de desfase variable de la trayectoria obtenida en la etapa b) con el movimiento del móvil sobre la misma.
d) Controlar automáticamente la velocidad del móvil en función de los parámetros obtenidos para cada tramo, de forma que se consiga una conducción automática a velocidad óptima sin salirse de pista. También se pueden ejecutar las órdenes recibidas en caso de tener el móvil conexión con el exterior.
5 De forma general consideramos una serie temporal como un conjunto de valores de un determinado fenómeno que varía en los períodos de tiempo o en diferentes tramos consecutivos de la trayectoria que caracterizan un circuito.
Indicando de forma genérica con Y los valores del fenómeno característico y con un índice n los periodos o tramos sucesivos, podemos notar la sucesión de valores como:
{yen): n = 1,2,3, oo. N} = Y1, Y2,Y3, oo .• , YN (1 )
En el caso de ser un circuito cerrado de N elementos, los valores se repetirán con una periodicidad igual al número de elementos N de que se compone el circuito.
(2)
15 Si introducimos en la trayectoria un móvil en un punto cualquiera y obtenemos la sucesión Z de valores del fenómeno observado, decimos que la nueva sucesión está retrasada respecto a la anterior Y el valor K, que llamamos retardo o desfase entre ambas sucesiones.
{Z(n): n = 1,2,3, oo' N, oo.} =Zl, Z2, Z3' oo .. , ZN, Zl, Z2, Z3, oo.
Z(n) = yen -K) (3)
(
{Z(n): n = 1,2,3, oo. N, oo.} = Y1 -K, Y2 -K, oo., YN-K, Y1 -K, Y2 -K, oo.
A estas sucesiones aplicamos el análisis de series temporales basados en la función de autocorrelación para determinar la periodicidad y el retardo entre ambas series.
Después construiremos el correlograma, representación gráfica de la correlación para diferentes desfases, donde observaremos la periodicidad al encontrar unos máximos en el 25 correlograma separados una distancia igual a la longitud de la serie de la variable que representa el circuito.
Si aumentamos progresivamente el desfase K observaremos que cuando las dos series están enfrentadas obtenemos un máximo de correlación entre ambas series. Este valor se repite periódicamente y alcanza el máximo cada vez que el desfase K es igual a un múltiplo
30 del número de elementos N del circuito.
S Para el proceso de cálculo partimos de la función de autocorrelación de desfase variable definida en la siguiente formula, donde Yes la variable característica a correlar, n el número de puntos de la serie y K el desfase entre las series
C(K) = ~~yen) yen -K)
(4)
(
K -1,2,3, ...
Esta función nos permite, eligiendo las variables características, determinar la periodicidad de la serie y observar los puntos de máxima amplitud en el correlograma (representación grafica de esta función), donde estos valores máximos representan los puntos en que el desfase K entre ellas es cero.
15 En el correlograma observaremos unos valores máximos separados un múltiplo del valor N. Esto nos va a permitir conocer la periodicidad durante el recorrido de reconocimiento repetitivo.
Aunque los procedimientos de autocorrelación son conocidos para el análisis de todo tipo de series temporales, su aplicación particular a la resolución del problema que nos ocupa es 20 novedosa por lo que, a riesgo de hacer algo extenso el texto, detallaremos los pasos necesarios de forma tal que sea entendido por un experto en la materia..
a) Generar una serie de parámetros característicos de cada tramo de la trayectoria durante un recorrido de reconocimiento repetitivo del móvil.
Sea un circuito cerrado no simétrico formado por un número M de carriles paralelos 25 separados una distancia D.
Cada uno de los carriles lo dividimos en N tramos compuestos por una curva y la recta que le precede.
Cada curva está definida por el arco de ángulo e y radio de curvatura R, la recta que le precede por su longitud L. Haremos L=O cuando la longitud de la recta sea menor que la
30 resolución de la medida.
5 Limitamos a RM el número máximo de radios de curvatura posibles. Asignamos a cada radio de curvatura RD de índice K ( dentro del conjunto de números naturales) el valor correspondiente calculado a partir del radio de menor curvatura RO y la separación entre carriles D.
RD(K) = RO + (K -1) x D
K E N (números naturales) (5)
(
O< K::; RM
10 Llamaremos i al índice del carril del circuito y j al índice de los tramos sucesivos que forman el carril.
Elegimos de forma arbitraria el origen en el tramo que contiene la recta más larga y le asignaremos el valor j=1, también convenimos en asignar el índice i=1 al carril situado a la derecha del circuito en el sentido del movimiento.
15 Consideramos, para definir el circuito, los parámetros característicos con las siguientes series:
- •
- S(ij) serie de sentido de giro de las curvas.
- •
- e(ij) serie de ángulos de las curvas.
• R(ij) serie de radios de las curvas. 20 • L(i,j) serie de longitudes de las rectas que preceden a las curvas.
Se observa que debido a las características del los valores de S, e y L son independientes del carril por el que circule el móvil.
Consideramos el sentido de giro S como positivo e igual a 1 cuando el giro es a derechas y 25 1 cuando es a izquierdas.
Si el circuito presenta simetría en la variable S, por ejemplo todas las curvas a la derecha, tendríamos que elegir otras de las series en el proceso de cálculo para eliminar esta simetría.
Al ser un circuito cerrado no simétrico las series tienen una periodicidad N igual al número 30 de tramos que lo componen.
{S(i,j): i = 1,2, ... M;j = 1,2, ... , N, ... } = Sl,S2, .,. ,Sn, '"
{e(i,j): i = 1,2, ... M;j = 1,2, ..,,N, ... } = el' e2, ... , en' ...
{R(i,j): i = 1,2, ... M;j = 1,2, ... , N, ... } = Rl , R2, ... , Rn, ...
{L(i,j): i = 1,2, ... M;j = 1,2, ... , N, ... } = Lv L2, ... , Ln, .. .
S(i,j) =S(i,j mod N) . N' e(i,j) = e(i,j mod N) \;fJ > . R(i,j) = R(i,j mod N)
{ (6)L(i,j) = L(i,j mod N)
i = indice_carril j = indice_tramo
M =número_de_carriles_detcircuito N =número_tramos_detcircuito
Con el objetivo de obtener datos para generar las series de parámetros característicos incorporamos el móvil al circuito en cualquier carril, al que asignamos el índice x, y en cualquier tramo de la trayectoria de índice de tramos sucesivos k=j-K, siendo K el número de
10 tramos de desfase con el origen prefijado para el circuito.
Hacemos con el móvil un recorrido de reconocimiento repetitivo a una velocidad lineal v conocida y constante, durante un número n de tramos.
Elegiremos n como un número par mayor que el doble de los N tramos esperados que componen los carriles del circuito dando como mínimo dos vueltas al circuito. El objeto es
15 tener la seguridad de que tenemos datos suficientes para realizar el proceso de cálculo de la función de autocorrelación para determinar la periodicidad del circuito como describiremos con detalle en el apartado b).
Podemos resumir las condiciones del recorrido realizado por el circuito:
V = Constante n> 2N (7) O<x~ M
{
N,M E N
Durante el recorrido, gracias a un dispositivo electrónico incorporado en el móvil hemos 20 medido el tiempo transcurrido entre la entrada y la salida de cada una de las curvas te' y entre la entrada y la salida de las rectas tr' que la preceden.
5 También, merced al giróscopo que incorpora, hemos medido las velocidades angulares w' en las curvas. Como criterio consideramos positivas las velocidades angulares en los giros hacia la derecha y negativas en los giros a la izquierda.
Con estas medidas obtenemos las siguientes series correspondientes al carril x del circuito que siendo k el índice de los tramos sucesivos que la componen.
10 • tr'(x, k) serie de los tiempos de las rectas que preceden a las curvas.
- •
- tc'(x, k) serie de los tiempos de las curvas.
- •
- w'(x, k) serie de las velocidades angulares de las curvas.
Notamos con el símbolo prima las variables medidas durante el recorrido de reconocimiento.
{tr'(x, k): k = 1,2, ... , n} = tr'!, tr'2, ... tr'n
{tc'(x, k): k = 1,2, ... ,n} = tc'v tc'2,'" tc'n
{w'(x, k): k = 1,2, ... , n} = w'!, W'2,'" w'n
(8)
n>N
x = número_carril
k = número_tramo_medido
n = número_tramos_medidos
N = número_tramos _deLcircuito
15 En el proceso de cálculo utilizaremos las funciones valor absoluto abs, parte entera ¡nt,
módulo mod y redondeo a un múltiplo red de un número definidas a continuación. La
aplicaremos a una variable Y siendo myel valor del que la variable será múltiplo entero.
Y>O
abs(Y) = IYI = {~y, Y<O
ínt(Y) = lYJ =max{k E ru: k:=:;; Y}
(9)
mod(Y, my) =y -l~yJ my
red(y, my) = [Y, my] = {
mod(Y, my) ~ ~y, (l~yJ+ 1)my
5 El objetivo es aproximar los valores obtenidos a múltiplos del menor valor posible. Por ejemplo, si el ángulo mínimo posible de una curva es 300 y obtenemos un valor calculado del ángulo 8 entre 1650 y 194 o a 8 se le asigna el valor de 1800
A partir de estas series de datos medidos definidos en (8) podemos calcular otras como la longitud de las rectas Ir' que utilizaremos en el apartado d),el sentido de giro en las curvas
10 s', el ángulo girado 8' y radio r' e índice K de cada una de ellas
{lr,(X, k): k = 1,2, ... ,n} = Ir'l, Ir'z, ... Ir'n
(10)
Ir'eX,k) = [vtr'(x,k),mz]
{ r
(11 )
- { {8'(X,k):k = 1,2, ... ,n} = 8'1,8'z, ... 8'n e'eX,k) = [lw'(x, k)1 te'(x, k), me]
- (12)
- ( {r,(x, k): k = 1,2, ... , n} = r'l, r'z, ... r'n [ 360 v ] r'(x,k) = 2rr Iw'(x,k)l,mr
- (13)
Calculamos el índice del radio de curvatura K en cada una de las curvas de la trayectoria por el carril x que utilizaremos posteriormente en el proceso de detección del número de carril.
r(x,k) -RO
K(x,k) = D +1
O< K ~ RM K E N mkk = 1 (14) D =separación_carriles RO =radio_menar_curvatura
{K'(x, k): k =1,2, ... ,n} =K'v K'z, ... K'n
(15)
, [r'(x, k) -RO ]
K (x, k) = D + 1,mk
10 Con los valores de las series obtenidas s' y 8' vamos a calcular a continuación la periodicidad de las series basada en la función de autocorrelación.
b) Caracterizar la trayectoria mediante autocorrelación de desfase variable de la serie de parámetros característicos, obteniendo su periodicidad.
15 Recordamos la fórmula del coeficiente de autocorrelación (4) como el sumatorio de los productos de los elementos de la una serie y la misma desfasada una distancia K. Este producto es máximo cuando el desfase K=O, repitiéndose este máximo cada vez que las series estén enfrentadas, es decir cuando el desfase sea múltiplo del número de tramos del circuito N.
C(K) =~Iyen) yen -K)
n n
K =0,1,2, ""2 5 En la fórmula, sustituimos el producto de los pares de elementos yen) yen -K) por la función f(Y(n), yen -K)) aquí definida
C(K) = l~~f(Y(n),yen -K))j
(16)
n
K = 0,1' ... '2 yen) = yen -K)
f(Y(n), yen -K)) = {~:
yen) =1= yen -K)
Aplicamos lo anterior a una o varias de las series obtenidas de parámetros característicos 10 calculados en (11), (12) Y (13).
También podemos utilizar una definición equivalente de C(K)
'r/ n : X(n) = X(n -K) (17)
C(K) = {~: 3 n : X(n) =1= X(n -K)
15 Con los n valores correspondientes al sentido de la curva s, ángulo girado 8 e índice K del radio de curvatura r calculados en (14), (12) Y (11) calculamos los coeficientes de correlación C(K) para los desfases K.
20 Para el sentido de la curva s el valor de Cs(K) será:
- f(s'(x,k),s'(x,k
- K)) = {~: s'(x, k) = s'(x, k s'(x, k) =1= s'(x, k K) K) (18)
- n K = 0,1, ... '2
- Para el ángulo de la curva 8 el valor de Co(K) será:
siendo (19) 8'(x, k) = 8'(x, k -K)
f(8'(x, k), 8'(x, k -K)) ={~: 8'(x, k) =1= 8'(x, k -K)
para
n
K = 0,1, ""2
S Utilizando la definición (15) podemos obtener los valores de la función como:
V k: s'(x,k) = s'(x,k -K)
3 k: s'(x,k) =1= s'(x,k -K) (20)
n
K = O,!, ""2
V k: 8'(x,k) = 8'(x,k -K)
3 k : 8'(x, k) =1= 8'(x, k -K) (21 )
n
K = 0,1, ""2
Para cada valor de K obtenemos para cada una de las variables un coeficiente Cy(K) obteniendo un coeficiente final C(K) conjunción lógica de los anteriores.
(22)
La periodicidad de la serie es la diferencia de los índices de dos elementos consecutivos de 10 la serie C(K) distintos de cero.
¡(23)1, "rj K: KmodN = O
C(K) =
O, 3 K: Kmod N '* O
5 El número de tramos del circuito N coincide con la distancia entre dos máximos consecutivos de la serie C(K)
Una vez conocidos el número de tramos de que se compone el circuito y el desfase entre el punto fijado como origen j=1 y el punto de entrada del móvil al circuito de índice k haremos una indexación de las series, con el criterio de que el índice igual a 1 sea el del tramo en
10 que la recta que precede a la curva sea de mayor longitud, mismo criterio que utilizamos en la definición del circuito.
Con las series medidas (8) y el desfase ya conocido K correspondientes al carril x del circuito que asignaremos como j el índice de los tramos sucesivos haremos la indexación de:
15 • tr(x, j) serie de los tiempos de las rectas que preceden a las curvas.
- •
- tc(x, j) serie de los tiempos de las curvas.
- •
- w(x, j) serie de las velocidades angulares de las curvas.
Notamos con minúsculas los parámetros característicos finales calculados para el circuito.
{treX,j):j = 1,2, ... , N} = tri' trz, ... trn
(24)
{t ( .) _ {tr'(x, k +K) , k :5 K r X,} -tr'(x, k +K -N), k > K
{tcex,j):j = 1,2, ... , N} = tCl' tcz, ... tCn
t ( .) {tc'(x, k + K) , k :5 K (25) { C X,} = tc'(x, k +K -N), k > K
{W(X,j):j = 1,2, ... ,N} = Wl,WZ' ... Wn .) {WI(x, k +K) , k :5 K (26)
(
(W X,} = w'(X,k+K-N), k>K
5 Y de las calculadas en (10), (11), (12) Y (13)
{lr(X,j):j = 1,2, ... , N} = lr1, lr2, ... , lrn
(27)
{ lr(x .) = {lr'(X,k + K) , k:::; K ,J lr'(x,k+K-N), k>K
{S(X,j):j = 1, ... ,N} =S1,S2, ... ,sn
(28)
S(X .) = {S'(x, k + K) , k :::; K ( ,J S'(X,k+K-N), k>K
{8(X,j):j = 1,2, ... ,N} =81,82, •.. ,8n
(29)
8(x .) ={8'(X, k + K) , k :::; K
{ ,J 8'(x,k+K-N), k>K
{r(x,j): j = 1,2, ... , N} =rl1 r2, ... ,rn
. {r'(x, k + K) , k :::; K (30) { r(x,J) = r'(x,k + K -N), k> K
{K(X,j):j = 1,2, ... ,N} =K1,K2, ... ,Kn
(31)
K(x ') = {K'(X, k + K) , k :::; K
{ ,J K'(x,k+K-N), k>K
Observamos que por ser un circuito de carriles paralelos y equidistantes las longitudes de
las rectas y los ángulos y sentido de giro son iguales e independientes del carril por el que
se circule. Por ello vemos que de las series anteriores solo podemos utilizar el radio de
10 curvatura para discriminar el carril por el que circulamos.
Una vez conocido los tramos de que se compone el circuito calculamos el número máximo
de carriles posibles y el carril por el que circulamos.
Partimos de la serie K(xj) (31) de índices de los radios de curvatura y de la serie w(xj) (26)
obtenida para conseguir el número de carriles posibles a la derecha c+
+( ') _ { K(x,j) -1, w(x,j) > O c X,] -RM _ K(x,j), (32)
w(x,j) < O RM = número]adios_posibles
Hacemos lo mismo para ver el número de carriles posibles a la a la izquierda c
_( ') {K(X,j) -1, w(x,j) < O c X,] = RM _ K(x,j), (33)
w(x,j) > O
RM =número]adios_posibles
Calculamos el mínimo de cada una de las dos series c+ y c-. La suma de los dos valores nos indica el número de carriles posibles, además de por el que circulamos, que pueden 10 existir en el circuito.
C- = mín{c-(x,j)} (34)
número_carriles-posibles = NC = C+ + C-+ 1
Por otro lado asignamos al carril por el que circulamos x el valor del mínimo número de carriles a la derecha c+ más uno. Este número no tiene por qué coincidir con el valor mínimo del índice del radio de curvatura K para dicho carril.
número_carril = X = C+ + 1 (35)
15 c) Localizar la posición del móvil sobre la trayectoria mediante correlación de desfase variable de la trayectoria obtenida en la etapa b) con el movimiento del móvil sobre la misma.
Una vez determinadas las características de las posibles trayectorias por los carriles del 20 circuito vamos a ver el método de localización del móvil cuando se incorpora en cualquier punto de la trayectoria en un circuito ya conocido.
Para ello se proponen dos métodos:
• Método de correlación de desfase variable de las series que vamos obteniendo con la progresión del móvil a lo largo de la trayectoria
5 • Método de reducción sucesiva de los puntos de posible localización del móvil en la progresión de éste a lo largo de la trayectoria
Incorporamos el móvil a un circuito cerrado, formado por un número M de carriles de N tramos cada uno, del cual conocemos sus parámetros característicos y aplicamos uno de los 10 dos métodos para hacer la localización del móvil.
c1) Método de correlación con desfase variable
Este primer método consiste en determinar la posición Pm,n obteniendo la función de correlación con desfase variable K las series de parámetros medidos con las series que caracterizan el circuito,
15 Calcularemos las funciones de correlación para estas series cuyo número de elementos n irá aumentando progresivamente.
n (36)
K = 1,2,3, "'2
n = 1,2,3, ... yen) = yen -K)
te(Y), yen - K)) = {~:
yen) "* yen -K)
Iremos formando una matriz en la que cada fila representa los valores de C(n,K) al paso por los tramos sucesivos n=1,2,3, ....
C(l,l) C(1,2) C(l, K))C(2,2) C(2,K) (37)
C = C(~,l)
( C(n,l) C(n,2) C(n,K)
Llegaremos a un punto donde la suma de los elementos de la función de correlación sea
igual a 1. En este punto habremos llegado a la localización del tramo n en que se encuentra 25 el móvil.
Para obtener el valor X del carril x por el que circulamos aplicamos el proceso ya descrito en (32), (33), (34) Y (35) según vamos avanzando por el circuito.
10 c2) Método de reducción
Cuando incorporamos el móvil al circuito lo podemos hacer en cualquier posición Px,y, luego partimos de una situación inicial en que cualquier punto es posible que representaremos como una matriz de dimensión M x N con todos sus elementos iguales a la unidad. En el caso de las variables s y 6, independientes del carril, el valor inicial se representa por una
15 matriz fila de n elementos iguales a la unidad.
Llamamos (X, Y) coordenadas reales de la posición del móvil y (x,y) coordenadas posibles de la posición del móvil
Coj = (1 1 ... 1)
Co(j) = 1 \;f j = 1, .. , N
1 1 ... 1) (39)
C .. = 1 1 ... 1
.. .
(
1 1 ... 1
Co( i,j) = 1 \;f i = 1, .. , M Y \;f j = 1, .. , N
20 Según vamos superando los tramos del recorrido por cualquier carril carril x obtenemos sucesivos valores del sentido de la curva s, ángulo de giro 6 a partir de la velocidad angular w aplicando (11) Y (12). Estas dos variables son independientes del número de carril por el que se circula.
s(x, 1), s(x, 2), s(x, 3), ... , s(l, N) s(x, y) =s(l,y)
8 (x, 1), 8 (x, 2), 8(x, 3), .. ,8(1, N)
(40)
e(x,y) = 8(1,y)
5 También calcularemos los índices de los radios de curvatura K a partir del radio r aplicando
(13) y (14). Esta variable nos va a dar además información sobre el número de carril por el que circula el móvil.
K(1,1),K'(1,2), ... ,K'(1,N)
(41)
K(2,1),K'(2,2), ... ,K'(2,N) {
K'(M,1,K'(M,2), ... ,K'(M,N)
Para calcular el tramo en que estamos, en el momento de superar cada uno de los tramos, 10 calculamos los elementos de la matriz Cs(n,j) y Ce(n,j) para los valores de sentido de giro s y ángulo girado 8:
( ') _{1, s'(x, n) = s(x,j +n -1)
c n,} -,
O, S (x, n) = s(x,j +n -1) j = 1,2,,,,N
(42)
Cs(n,j) = Cs(n -1,j) 1\ c(n,j) j = 1,2, ... ,N
n = 1,2,3, ...
_{P(X,j +n), 3!j: C()(n,j) = 1, min¡n E1\1: fC,(n,j) = 1J
Px,Y -J=l (43)
Y =j+n
c(n .) ={1, 8'(x, n) =8(x,j + n -1) ,1 O, 8'(x, n) = 8(x,j +n -1) j = 1,2,3, ... ,N
(44)
C()(n,j) = C()(n -1,j) 1\ c(n,j) j = 1,2,3, ... ,N
n = 1,2,3,,,.
_ {P(X,j +n), 3!j: C()(n,j) = 1, min{n E 1\1: tC.(n,j) = 1}
PX,Y
J=l
Y=j+n
(45)
5 Cuando llegamos a un punto n de la trayectoria donde se cumple la condición de que I.7=1 C (n,j) = 1 en cualquiera de las variables analizadas, podemos decir que hemos llegado a una posición conocida y única del número de tramo para situar el móvil en la trayectoria y su valor es Y = j + n
Si repetimos la operación para el índice del radio de curvatura K, variable de la que depende 10 el número de carril por el que circulamos.
Calculamos los elementos de la matriz CK(n,ij) , para el primer punto n donde se cumpla la condición de que I.rj~l CK(n, i,j) = 1 a partir de los valores de los índices i y j obtendremos los X, Y correspondientes al carril y al número de tramo por los que circulamos.
. ') _ {l,K'(i, n) = K(i,j + n -1)
en,l,]( -,
O, K (i, n) = K(i,j + n -1)
i=1,2, .. ,M
(46)
j = 1,2, ... ,N
CK(n, i,j) = CK(n -1, i,j) 1\ e(n, i,j)
i = 1,2, .."M
j = 1,2, ... ,N
n = 1,2,3, ...
M,N }
P(i,j + n), 3! i,j: CK(n, i,j) = 1, min n E N:.L CK(n, i,j) = 1
{
I,J=l
PX,y =
(47) x = i
Y =j+n
15 El primero de los valores (43) y (45) que cumpla la condición nos va a dar el número de tramo y por el que circula el móvil. Una vez determinado el tramo Y podemos analizar si en ese momento ya existe una condición para saber el número de carril, si no fuese así continuaremos el recorrido hasta que se cumpla
P _ {P(i, y + n), 3! i: CK(n, i, Y) = 1, min¡n E 1\1: tCK(n, i, Y) = 1)
X,Y
(48)
X = i
A partir de este momento conocemos la posición del móvil sobre el circuito y nos limitaremos 20 a comprobar en los tramos sucesivos con (43) que el sincronismo no se ha perdido.
5 d) Controlar la velocidad del móvil en función de los parámetros obtenidos para cada tramo, y/o ejecutar las órdenes recibidas en caso de tener el móvil conexión con el exterior.
Una vez conocida la posición del móvil en la trayectoria podemos calcular la velocidad máxima del circuito en cada curva y aplicar a cada tramo las velocidades adecuadas.
Partimos de la formula de la velocidad máxima que puede alcanzar un vehículo en curva.
sena + Jl. cosa
(49)
Vmax =
B R cosa -Jl. sena
Siendo R el radio de curvatura tr el ángulo del peralte, J.l el coeficiente de rozamiento y 9 la aceleración de la gravedad.
Si consideramos que el peralte es cero nos queda
(50)
15 En la parte recta de los tramos, conocidas la velocidad de entrada y la velocidad máxima de la curva podemos calcular la distancia de frenada d
1 2 1 2
m B Jl. d =2" m VI -2" m vi (51 )
d = v/ -v/
2BJl.
Donde m es la masa del móvil y Vi, VI las velocidades inicial y final.
Estos valores límites podrán ser modificados en cada momento si el móvil dispone de un 20 sistema de comunicación capaz de recibir órdenes de respuesta inmediata.
Las distintas etapas que se acaban de describir se implementaran en función de la aplicación de que se trate. En un circuito de "slot", la etapa c) es imprescindible ya que las salidas de pista son continuas. En sistemas de conducción automática en tamaño real, dicha función no tiene sentido.
25 Obsérvese que el procedimiento propuesto siempre permite caracterizar una trayectoria simple por el método de autocorrelación de desfase variable. En el caso de varias pistas posibles, paralelas y con posibilidad de cruce, el cálculo se complica y es preciso recurrir a condiciones de contorno de los índices para obtener elementos adicionales de cálculo.
Para complementar la descripción que antecede, y con objeto de ayudar a una mejor comprensión de la invención, se va a proceder a realizar una descripción detallada de una realización preferida del dispositivo de la invención aplicado a coches de "slot", en base a un juego de planos que se acompañan a esta memoria descriptiva y en donde, con carácter orientativo y no limitativo, se ha representado lo siguiente.
La figura 1 muestra un diagrama de bloques del dispositivo de medida y control (DMC).
La figura 2 muestra una vista en planta del vehiculo de slot (sin carrocería) sobre los carriles de guía y alimentación, en un punto de cambio de carril.
La figura 3 muestra el circuito de "slot" de 7 tramos cuya trayectoria se va a caracterizar.
La figura 4 muestra las curvas posibles para 8 carriles.
La figura 5 muestra las curvas posibles para 6 carriles.
La figura 6 muestra el correlograma obtenido durante el recorrido de reconocimiento.
La figura 7 muestra los parámetros de frenado antes de curva.
La figura 8 muestra el paso por una curva peraltada.
En las anteriores figuras, las referencias numéricas corresponden a las siguientes partes y elementos:
- 1.
- Regulador de tensión y protecciones eléctricas
- 2.
- Multiprocesador
- 3.
- Memoria volátil y de programa
- 4.
- Reloj en tiempo real
- 5.
- Sensor de tensión en pista
- 6.
- Control de motor por modulación de pulsos ( PWM )
- 7.
- Sensor de velocidad angular del vehículo
- 8.
- Transmisor-receptor de radio
- 9.
- Carriles pista
10. Motor
Las figuras 1 a 8 muestran la instalación en el interior de un vehículo a escala de "slot" de un dispositivo electrónico de medida, proceso y control compuesto por multiprocesador, memoria, sensor de tensión de pista, sensor de medida de velocidad angular (MEMS) o giróscopo, y controlador de potencia por modulación de ancho de pulso (PWM) del motor de corriente contínua de impulsión.
Este dispositivo adquiere datos en tiempo real de la velocidad angular del vehículo, los procesa para el cálculo de las velocidades máximas de entrada y salida de cada tramo y los transmite al mando de control a través de un enlace de radio.
El sistema controla la potencia del motor con los comandos recibidos de un mando a distancia o directamente de los resultados del proceso de los datos obtenidos.
Este proceso se puede realizar de forma automática o controlada con un mando manejado por el piloto en el juego.
El sistema consiste en un dispositivo de medida y control (DMC) en el interior de cada vehículo y un mando electrónico para el piloto (MEP) conectados en red vía radio.
El DMC está compuesto por los siguientes elementos interconectados (ver figura 1):
- 1.
- Regulador de tensión y protecciones eléctricas
- 2.
- Multiprocesador
- 3.
- Memoria volátil y de programa
- 4.
- Reloj en tiempo real
- 5.
- Sensor de tensión en pista
- 6.
- Control de motor por modulación de pulsos ( PWM )
- 7.
- Sensor de velocidad angular del vehículo
- 8.
- Transmisor-receptor de radio
1) Regulador de tensión y protecciones eléctricas
El sistema está preparado para trabajar con tensiones en pista de 6V a 30V protegido contra inversión de polaridad y con la regulación de tensión necesaria para los elementos que lo componen.
2) Multiprocesador
El sistema multiprocesador está capacitado para realizar hasta ocho procesos simultáneos que permiten la medida de los sensores, proceso de datos, transmisión de datos, recepción de comandos y control del motor en tiempo real.
3) Memoria volátil y de programa Memoria volátil para el proceso de datos y no volátil reprogramable para el almacenamiento del programa, constantes y parámetros del circuito.
4) Reloj en tiempo real
Unidad para el control temporal de las series de medidas basada en la base de tiempos del procesador capaz de medir con precisión mayor del milisegundo los tiempos de cada vuelta al circuito.
5) Sensor de tensión en pista
Medida de la tensión en pista en el punto donde se encuentra el vehículo con carga del motor o sin ella para determinar la calidad de la pista y la tensión disponible en cada tramo.
6) Control de motor por modulación de pulsos ( PWM ) Unidad de control de potencia del motor para su giro y frenado mediante modulación de pulsos basado en un puente de transistores MOSFET.
Este circuito controla la velocidad del motor mediante pulsos de área variable de amplitud igual a la tensión del circuito.
La medida de la tensión en pista permite corregir la potencia entregada al motor cambiando el ancho del pulso para mantener el área constante en las zonas en que existan variaciones de la tensión de pista respecto a la nominal.
De esta forma conseguimos que el error en la velocidad del vehículo cuando recibe la orden de viajar a velocidad constante sea inferior al 5% La posibilidad de cortocircuito del motor con una resistencia mínima permite utilizar la fuerza contraelectromotriz para la función de frenado.
7) Sensor de velocidad angular del vehículo
Sensor de medida de velocidad angular del vehículo de 0-2000 grados/seg de rango de tipo MEMS con resolución de un o/seg.
Su función es localizar las entradas y salidas en los tramos curvos y dar el valor de la velocidad angular real en los tramos curvos de la trayectoria.
8) Transmisor-receptor de radio
La transmisión de los datos obtenidos y la recepción de los comandos se realiza a través de una red en la banda ISM 2.4 Ghz. según especificaciones IEEE 802.15.4 Y que cumple las normativas FCC, IC y CE que permite su utilización legal sin licencia.
Este dispositivo se sitúa físicamente en el chasis del vehículo entre las trencillas de toma de corriente y el motor de impulsión ( Figura 2)
Mando electrónico para el piloto ( MEP)
El mando permite transmitir al DMC los comandos del piloto para la regulación de velocidad,
ordenes de cambio de pista y control de otros elementos auxiliares como por ejemplo la
iluminación del vehículo.
Este mando recibe los datos de telemetría que son utilizados para configurar las curvas de respuesta del mando.
El dispositivo incorpora un programa capaz de leer los diferentes sensores controlar el motor, transmitir datos, recibir órdenes y ejecutar los algoritmos descritos en el apartado Descripción de la invención.
A modo de ejemplo veremos a continuación el proceso de cálculo en las distintas fases descritas cuando el vehículo es situado en un circuito de slot.
a) Generar una serie de parámetros característicos de cada tramo de la trayectoria durante un recorrido de reconocimiento repetitivo del móvil.
Sea un circuito de slot (figura 3) formado por seis carriles paralelos separados una distancia D, dividido en siete tramos formados por una curva y la recta que le precede.
Las características de las pistas con las que se ha diseñado el circuito y el recorrido de de
prueba son los siguientes:
- •
- Radio menor de curvatura RO=247 mm
- •
- Distancia de separación entre carriles D=99 mm
• Número de radios posibles RM=8 10 • Radios de curvatura RD en mm
{RD(K): K = 1,2,3, 000 8} = 247,346,445,544,643,742,841,940
- •
- Número de carriles M= 6
- •
- Número de tramos N= 7
Si el número de carriles es igual al máximo de los radios posibles solo puede existir un radio de curvatura posible a la derecha y otro a la izquierda ( Figura 4)
Tabla 1 Radios posibles en los carriles M=8
- M
- K+ K"
- 1
- a 1 8
- 2
- b 2 7
- 3
- c 3 6
- 4
- d 4 5
- 5
- e 5 4
- 6
- f 6 3
- 7
- 9 7 2
- 8
- h 8 1
Al ser el número de carriles seis existen dos radios posibles a la derecha y otros dos a la izquierda para cada carril (Figura 5)
Tabla 2
Radios posibles en los carriles M=6
- M
- K+ K+ K" K"
- 1
- a 1 3 6 8
- 2
- b 2 4 5 7
- 3
- c 3 5 4 6
- 4
- d 4 6 3 5
- 5
- e 5 7 2 4
- 6
- f 6 8 1 3
Realizamos un recorrido de reconocimiento a velocidad constante tomando un número de 15 medidas de la velocidad angular w superior al doble de los tramos esperados a una tasa de muestreo constante según las condiciones del recorrido (7). Velocidad del recorrido= 1 mIs Tasa de muestreo = 200 muestrasls Número de tramos medidos=16 n> 2N 20 Los parámetros característicos del circuito definidos en (6) para el circuito de la figura 1 serán:
Tabla 3 Parámetros reales característicos del circuito
- j
- 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
- S
- -1 1 -1 1 1 1 -1 -1 1 -1 1 1 1 -1 -1 1
- e
- 150 180 240 120 240 30 180 150 180 240 120 240 30 180 150 180
- R
- 545 446 743 446 446 644 743 545 446 743 446 446 644 743 545 446
- L
- 5860 2070 1720 4140 1380 1960 690 5860 2070 1720 4140 1380 1960 690 5860 2070
Situamos el móvil en un punto de índice (x,k) siendo x el carril y k=j-K+1 el tramo del circuito y hacemos el recorrido de reconocimiento y obtenemos los valores de número de 10 muestras en rectas nr y curvas ne así como la velocidad angular w
Para el ejemplo se han considerado los valores teóricos con un error aleatorio del 5% Tabla 4 Medidas brutas
- k
- 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
- nr'
- 869 284 403 143 1207 422 347 836 287 392 138 1183 434 361 869 284
- nc'
- 197 374 69 468 288 282 648 188 392 68 477 288 294 642 197 374
- w'
- 135 134 89 -80 -111 135 -81 130 131 90 -78 -105 131 -79 135 134
15 Calculamos los tiempos de recorrido en curvas y rectas tr' y te' en milésimas de segundo a partir de la velocidad y el número de muestras Tabla 5 Medidas brutas
- k
- 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
- tr'
- 4345 1420 2015 715 6035 2110 1735 4180 1435 1960 690 5915 2170 1805 4345 1420
- te'
- 985 1870 345 2340 1440 1410 3240 940 1960 340 2385 1440 1470 3210 985 1870
- w'
- 135 134 89 -80 -111 135 -81 130 131 90 -78 -105 131 -79 135 134
20 Aplicando las funciones definidas en (9) y (14) calculamos los valores de los parámetros característicos del circuito (10), (11), (12), (13) Y (15).
Consideramos el valor intermedio 9 el ángulo de la curva antes de aplicar la función de redondeo a un múltiplo de 30° haciendo me=300, mínimo ángulo de los tramos curvos posibles .Una vez aplicada obtenemos en ángulo 8' en el que se ve que los ángulos son
25 múltiplos del valor mínimo.
De igual manera procedemos para obtener el valor redondeado del índice K' siendo mk=1 Tabla 6 Parámetros calculados característicos del circuito
- k
- 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
- Ir'
- 4350 1420 2020 720 6040 2110 1740 4180 1440 1960 690 5920 2170 1810 4350 1420
- s'
- 1 1 1 -1 -1 1 -1 1 1 1 -1 -1 1 -1 1 1
- 9
- 132 250 30 187 159 190 262 122 256 30 186 151 192 253 132 250
- 9'
- 120 240 30 180 150 180 240 120 240 30 180 150 180 240 120 240
- r'
- 424 428 644 716 516 424 707 441 437 637 735 546 437 725 424 428
- K'
- 3 3 5 6 4 3 6 3 3 5 6 4 3 6 3 3
5 b) Caracterizar la trayectoria mediante autocorrelación de desfase variable de la serie de parámetros característicos, obteniendo su periodicidad.
Con las series obtenidas s' y 8' calculamos las funciones ClK) y Ce(K) basadas en la función de correlación (18) y (19) o (20) y (21)
Tabla 7
10 Función de correlación de los parámetros del circuito
Las funciones ClK) y Ce(K) según (23) tienen la propiedad de repetir su valor cada N elementos. 32La distancia entre máximos consecutivos de estas series es igual al número de tramos N
15 En el caso que nos ocupa, se observa en el correlograma de la figura 6 como la función autocorrelacion toma un máximo para valores 4 y 11 del número de tramos (en el resto es cero), por lo que el número de tramos de que consta el circuito (periodicidad) será de 11 -4 =7
Buscaremos entre los siete tramos que componen la serie el de mayor longitud, en este 20 caso se trata del tramo de índice k=5 .
Corregimos el desfase y hacemos una indexación de los tramos aplicando (24), (25), Y (26) de los valores medidos
Tabla 8
Medidas brutas re-indexadas
- j
- 1 2 3 4 5 6 7
- tr
- 5915 2170 1805 4345 1420 2015 715
- tc
- 1440 1470 3210 985 1870 345 2340
- w
- -105 131 -79 135 134 89 -80
Igualmente para los valores calculados a partir de ellos (27), (28), (29), (30) Y (31) Tabla 9 Parámetros característicos del circuito re-indexados
- j
- 1 2 3 4 5 6 7
- Ir
- 5920 2170 1810 4350 1420 2020 720
- s
- -1 1 -1 1 1 1 -1
- e
- 150 180 240 120 240 30 180
- r
- 546 437 725 424 428 644 716
- K
- 4 3 6 3 3 5 6
Donde; 10 Ir: longitud recta previa
- s : sentido de giro de la curva
- r : radio de la curva
K : índice de radio de curvatura A partir de la serie de índices K aplicamos (32) y (33) para obtener el número máximo de 15 carriles posible a derecha e izquierda.
Tabla 10 Cálculo del número máximo de carriles
- j
- 1 2 3 4 5 6 7
- w
- -105 131 -79 135 134 89 -80
- K
- 4 3 6 3 3 5 6
- c+
- 2 2 2 4
- c -
- 3 5 5
Aplicando (34) Y (35) obtenemos
20 • Número de carriles posibles =6
• Número de carril actual =3
c) Localizar la posición del móvil sobre la trayectoria mediante correlación de desfase variable de la trayectoria obtenida en la etapa b) con el movimiento del móvil sobre la misma.
5 Una vez conocidas las características del circuito vamos a analizar el método de sincronización al incorporar el móvil en cualquier carril y tramo de éste. En el ejemplo incorporamos el móvil en el carril de índice tres y en el tramo de índice cuatro.
c1) Método de correlación con desfase variable
En este método, cada vez que superamos un tramo del circuito, hacemos con los valores de
10 S'n y 6'n hasta ese momento conocidos la correlación de estos con los valores característicos de los siete tramos del circuito s y 6 obtenidos en el apartado b), Recordemos que estos valores son independientes del carril por el que se circule.
Continuamos el proceso hasta alcanzar el primer valor de r. CCm, k) = 1 según (38) para n=3, obteniendo el índice j=4 que nos indica el número de tramo en curso es Y=j+n=7
15 Tabla 11
Serie de correlación de desfase variable del sentido de giro
Observamos que para el valor de s', sentido del ángulo girado, obtenemos el valor del tramo después de recorrer tres tramos. Si consideramos, en este ejemplo, también el ángulo girado 6' el valor del tramo en que nos encontramos se reconoce después de recorrer el primer tramo n=1 entonces obtenemos para el tramo en curso el valor Y=j+n=5
5 c2) Método de reducción
Este método, equivalente al anterior, consiste en partir de una posición inicial en la que el móvil se puede incorporar en cualquier carril y tramo representado por una matriz con todos sus elementos iguales a uno e ir haciendo cero los puntos en que no es posible estar según vamos avanzando por el circuito.
10 Para las variables s' y 8' la matriz es una matriz fila de 7 elementos igual a los tramos del circuito y para el índice de los radios de curvatura una matriz de dimensión 6 x 7 correspondiente al número de carriles M y de tramos N (42),(43),(44) Y(45)
Tabla 13
Matriz de posición en tramo con el sentido de giro s
- k
- 1 2 3 4 5 6 7 8 9 10 11 12 13 14
- s
- -1 1 -1 1 1 1 -1 -1 1 -1 1 1 1 -1
- s'
- 1 1 1 -1 -1 1 -1 1 1 1 -1 -1 1 -1
- n
- s'o l:C(n,k)
- O
- C(O,k) 1 1 1 1 1 1 1 8
- S'1
- 1
- 1
- C(1,k) O 1 O 1 1 1 O 4
- S'2
- 1 1
- 2
- C(2,k) O O O 1 1 O O
- 2
- S'3
- 1 1 1
- 3
- C{3,k) O O O 1 O O O 1
Tabla 14 Matriz de posición en tramo con el ángulo de la curva 8
- k
- 1 2 3 4 5 6 7 8 9 10 11 12 13 14
- 8
- 150 18 O 24 O 12 O 24 O 30 18 O 150 180 240 120 24 O 30 18 O
- 8'
- 120 24 O 30 18 O 15 O 18 O 24 O 120 240 30 180 15 O 180 24 O
- n
- 8'0 rC(n, k'
- O
- C(O,k ) 1 1 1 1 1 1 1 8
- 8'1
- 120
- 1
- C(1,k ) O O O 1 O O O
- 1
5 Se observa en el ejemplo que para la variable s se detecta el valor del tramo al pasar el tercer tramo que nos indica que el tramo en que nos encontramos después de la sincronización es el tramo Y=j+n=7 mientras que para e lo conseguimos al pasar primer tramo encontrandonos en el tramo Y=j+n=5 después de la sincronización.
Hacemos el mismo proceso para la matriz de 6 x 7 de los índices de los radios de curvatura 10 K para cada uno de los carriles y tramos. (46) (47)
Vemos que el carril X=3 por el que circula se detecta al pasar el tercer tramo. El tramo en
que nos encontramos después de la sincronización será Y=j+n= 7
Hemos utilizado de forma independiente las variables s, 9 y K. Si utilizamos conjuntamente los criterio vemos en la tabla 14 que en la primera curva la variable 9 determina que la posición es el índice de tramo k=4, si consultamos la tabla 15 veremos que en la primera
10 curva en el tramo cuatro solo es posible que el vehículo circule por el carril x=3. En este supuesto habremos encontrado el carril y el tramo ( X, Y) cuando nos encontramos en el tramo Y=j+n=5 (48)
Una vez sincronizado el móvil, mientras no se pierda de forma accidental el sincronismo, veremos que el valor de la suma de las posiciones posibles se mantiene igual a uno.
15 d) Controlar la velocidad del móvil en función de los parámetros obtenidos para cada tramo, y/o ejecutar las órdenes recibidas en caso de tener el móvil conexión con el exterior.
Cuando el móvil reconoce el carril y tramo en que se encuentra, mientras no reciba ordenes en contra, procederá a aplicar en cada tramo las velocidades óptimas en cada tramo calculadas según las fórmulas (49) y (50).
20 Considerando un valor del coeficiente de rozamiento J.L=1,2 Y un ángulo de peralte a=O obtenemos la aceleración máxima Amax Y la velocidad máxima Vmax para cada índice de radio de curvatura K, y la velocidad angular máxima wmaxpara cada curva (ver figura 8).
Este valor será fijado como consigna para que el procesador controle la potencia del motor del móvil, en función de los datos recibidos del sensor de velocidad angular para que este 25 límite no sea superado.
Tabla 16
- K
- Amax (m/s2 ) Vmax (mIs) w (rad) w (0)
- 1
- 11,76 1,708 6.9 395
- 2
- 11,76 2,020 5.8 334
- 3
- 11,76 2,290 5.1 294
- 4
- 11,76 2,532 4.6 266
- 5
- 11,76 2,752 4.3 245
- 6
- 11,76 2,956 4.0 228
- 7
- 11,76 3,147 3.7 214
- 8
- 11,76 3,327 3.5 203
S Una vez superada la curva 7 punto a (figura 3), si no se reciben órdenes en contra, el móvil se pondrá a la velocidad máxima que permita el motor hasta alcanzar el punto f en que tiene que frenar (ver figura 7) para cumplir la condición anterior en el punto b entrada de la curva 1 (51), volviendo a acelerar a partir del punto c.
Claims (4)
- REIVINDICACIONES1. Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, caracterizado por comprender las siguientes etapas:a) Generar una serie de parámetros característicos de cada tramo de la10 trayectoria durante un recorrido de reconocimiento repetitivo del móvil a una velocidad v, conocida y constante, durante un número de tramos n par y superior al doble del número máximo de tramos esperado, al menos de alguno de los siguientes parámetros;• S(ij) serie de sentido de giro de las curvas. 15 • S(ij) serie de ángulos de las curvas.
- •
- R(ij) serie de radios de las curvas.
- •
- L(ij) serie de longitudes de las rectas que preceden a las curvas.
b) Caracterizar la trayectoria mediante autocorrelación de desfase variable de la 20 serie de al menos algún parámetro característico, obteniendo su periodicidad, según las formulas generales de la autocorrelacion,(16)nK = 0,1, ""2 yen) = yen -K)t(yen), yen -K)) = f~: yen) *" yen -K)Siendo la periodicidad de la serie de parámetros que caracteriza la trayectoria la diferencia de los índices de dos elementos consecutivos de la serie C(K) distintos de cero.1'C(K) =O,(23)'r/ K : Kmod N = O 3 K: Kmod N =1= O- 5
- 2. Procedimiento de caracterización de trayectorias encarriladas desconocidas
- recorridas por un móvil de acuerdo con la reivindicación 1, caracterizado por
- comprender la siguiente etapa adicional,
- c1)
- Localizar la posición del móvil sobre la trayectoria mediante
- 10
- correlación de desfase variable de la trayectoria obtenida en la etapa
- b)
- con el movimiento del móvil sobre la misma, determinando la
- posición Pm,n mediante la obtención de
- la función de correlación con
- desfase variable K de las series de parámetros medidos con las series
- que caracterizan el circuito.
- 15
- Calcularemos las funciones de correlación para estas series cuyo
- número de elementos n irá aumentando progresivamente.
C(n,K) ~ l~f{(yen), yen -K))j.n (36)K = 1,2,3, "'2n = 1,2,3, ...yen) = yen -K)t((Y), yen -K)) ={~:yen) =1= yen -K)Llegaremos a un punto donde la suma de los elementos de la función de correlación sea igual a 1. En este punto habremos obtenido la localización del tramo n en que se encuentra el móvil.- 5
-
- 3.
- Procedimiento de caracterización de trayectorias encarriladas desconocidas
- recorridas por un móvil de acuerdo con la reivindicación 1, caracterizado por
- comprender la siguiente etapa adicional,
- c2) Localizar la posición del móvil sobre la trayectoria mediante el
- 10
- método de reducción sucesiva de los puntos de posible localización
- del móvil en la progresión de este a lo largo de la trayectoria. Cuando
- se incorpora el móvil al circuito puede hacerlo en
- cualquier posición
- Px,y, luego partimos de una situación inicial en que cualquier punto es
- posible que representaremos como una matriz de dimensión M x N
- 15
- con todos sus elementos iguales a la unidad. En el caso de las
- variables s y 8, independientes del carril, el valor inicial se representa
- por una matriz fila de n elementos iguales a la unidad.
- Llamamos (X, Y) coordenadas reales de la posición del móvil y (x,y)
- coordenadas posibles de la posición del móvil
- 20
COj = (1 1 ... 1) Co(j) = 1 'V j = 1, .. ,N- (39)
- 1
- 1
-
- 1e .. = (o1,] ~
- 1 ~ i)
Co(i,j) = 1'V i = l, .. ,My 'V j = 1, .. ,NSegún vamos superando los tramos del recorrido por cualquier carril carril x obtenemos sucesivos valores del sentido de la curva s, ángulo de giro 8 a partir de la velocidad angular w aplicando (11) y (12). Estas dos variables son independientes del número de carril por el que se circula.Se han de calcular tambien los índices de los radios de curvatura K apartir del radio r aplicando (13) y (14). Esta variable nos va a dar además información sobre el número de carril por el que circula el móvil.K(l,1), K'(l,2), ... ,K'(l, N)(41)K(2,l), K'(2,2), ... , K'(2, N){K'(M,l,K'(M,2), ... ,K'(M,N)Si repetimos la operación para el índice del radio de curvatura K, variable de la que depende el número de carril por el que circulamos, y calculamos los elementos de la matriz CK(n,ij) , para el primer punto n donde se cumpla la condición de que Z:fj;;l CK(n, i,j) = 1 a partirde los valores de los índices i y j obtendremos los X, Y correspondientes al carril y al número de tramo por los que circulamos.P(í,j + n), 3! í,j: CK(n, í,j) = 1,PX,y =x = í Y=j+n15 El primero de los valores (43) y (45) que cumpla la condición nos va a dar el número de tramo y por el que circula el móvil. Una vez determinado el tramo Y podemos analizar si en ese momento ya existe una condición para saber el número de carril, si no fuese así continuaremos el recorrido hasta que se cumpla la condición;_ {P(í, Y + n), 3! i: CK(n, i, Y) = 1, min{n E 1\1: t,CK(n, i, Y) = 1JPx,y(48)X = í20 A partir de este momento se conoce la posición del móvil sobre el circuito y será suficiente comprobar comprobar, en los tramos sucesivos con (43), que el sincronismo no se ha perdido.- 5
- 4. Procedimiento de caracterización de trayectorias encarriladas desconocidas
- recorridas por
- un móvil acuerdo con la reivindicación 1, caracterizado por
- comprender la siguiente etapa adicional,
- d)
- Controlar la velocidad del móvil en función de los parámetros
- obtenidos para cada tramo, y/o ejecutar las
- órdenes recibidas en caso
- 10
- de tener el móvil conexión con el exterior.
- Una
- vez conocida la posición del móvil en la trayectoria podemos
- calcular la velocidad máxima admisible en cada curva y aplicar a cada
- tramo las velocidades adecuadas.
- Partimos de la formula de la velocidad máxima que puede alcanzar un
- 15
- vehículo en curva;
sena + /1 cosa(49)9 R cosa -/1 senaSiendo R el radio de curvatura tr el ángulo del peralte, ¡.t el coeficientede rozamiento y 9 la aceleración de la gravedad.20 En la parte recta de los tramos, conocidas la velocidad de entrada y la velocidad máxima de la curva podemos calcular la distancia de frenada d1 2 1 2m 9 /1 d = '2 m vf -'2 m Vi(51 )( Vf 2 -V·2d= 129/1Donde m es la masa del móvil y Vi, Vf las velocidades inicial y final. - 5. Dispositivo para la caracterización de trayectorias encarriladas desconocidas recorridas por un móvil que, ejecutando el procedimiento de las reivindicaciones anteriores, está constituido por los siguientes elementos;
- s
- Un dispositivo de medida y control (DMC) que comprende, Un regulador de tensión y protecciones eléctricas,
- Un multiprocesador capacitado para realizar la medida de los sensores, proceso de datos, transmisión de datos, recepción de comandos y control del motor en tiempo real,
- 10
- Una memoria volátil para el proceso de datos y no volátil reprogramable para el almacenamiento del programa, constantes y parámetros del circuito,
- Unidad para el control temporal de las series de medidas basada en la base de tiempos del procesador,
- lS
- Sensor de tensión en pista para la medida de la tensión en el punto donde se encuentra el vehículo,
- Unidad de control de potencia del motor para su giro y frenado mediante modulación de pulsos,
- 20
- Sensor de medida de la velocidad angular del vehículo,
- Transmisor-receptor de radio
- 25
- Un mando electrónico para el piloto (MEP) conectado con el dispositivo de medida y control (DMC) vía radio, para transmitirle los comandos del piloto referentes a la regulación de velocidad, ordenes de cambio de pista y control de otros elementos auxiliares.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
ES201430808A ES2552711B2 (es) | 2014-05-28 | 2014-05-28 | Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
ES201430808A ES2552711B2 (es) | 2014-05-28 | 2014-05-28 | Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado |
Publications (2)
Publication Number | Publication Date |
---|---|
ES2552711A1 true ES2552711A1 (es) | 2015-12-01 |
ES2552711B2 ES2552711B2 (es) | 2016-11-08 |
Family
ID=54652003
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
ES201430808A Expired - Fee Related ES2552711B2 (es) | 2014-05-28 | 2014-05-28 | Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado |
Country Status (1)
Country | Link |
---|---|
ES (1) | ES2552711B2 (es) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES1035915U (es) * | 1996-11-22 | 1997-06-16 | Moya Larano Julio Antonio | Dispositivo acustico adaptable a pistas de carreras. |
ES2264037T3 (es) * | 2002-10-28 | 2006-12-16 | Siemens Aktiengesellschaft | Procedimiento para la sincronizacion descentralizada en un sistema de comunicaciones por radio autoorganizable. |
ES2288101B1 (es) * | 2005-12-21 | 2008-10-16 | Ninco Desarrollos, S.L. | Sistema de localizacion en pistas de vehiculos electricos a escala de control digital. |
ES2324387A1 (es) * | 2009-01-23 | 2009-08-05 | Bycmo Rc Models, S.L | Sistema de gestion y control del movimiento de un vehiculo de slot. |
WO2010018252A1 (es) * | 2008-07-28 | 2010-02-18 | Bycmo Rc Models, S.L. | Chasis para vehículo de slot a escala con posibilidad de subviraje |
WO2012140287A1 (es) * | 2011-04-15 | 2012-10-18 | Bolea Noya Sergi | Bastidor para vehículos de slot |
-
2014
- 2014-05-28 ES ES201430808A patent/ES2552711B2/es not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES1035915U (es) * | 1996-11-22 | 1997-06-16 | Moya Larano Julio Antonio | Dispositivo acustico adaptable a pistas de carreras. |
ES2264037T3 (es) * | 2002-10-28 | 2006-12-16 | Siemens Aktiengesellschaft | Procedimiento para la sincronizacion descentralizada en un sistema de comunicaciones por radio autoorganizable. |
ES2288101B1 (es) * | 2005-12-21 | 2008-10-16 | Ninco Desarrollos, S.L. | Sistema de localizacion en pistas de vehiculos electricos a escala de control digital. |
WO2010018252A1 (es) * | 2008-07-28 | 2010-02-18 | Bycmo Rc Models, S.L. | Chasis para vehículo de slot a escala con posibilidad de subviraje |
ES2324387A1 (es) * | 2009-01-23 | 2009-08-05 | Bycmo Rc Models, S.L | Sistema de gestion y control del movimiento de un vehiculo de slot. |
WO2012140287A1 (es) * | 2011-04-15 | 2012-10-18 | Bolea Noya Sergi | Bastidor para vehículos de slot |
Non-Patent Citations (1)
Title |
---|
Control de velocidad de un motor DC mediante la utilización de un sensor magnético y micro controlador (JOAN ESCRIVÀ ARLANDIS ) 31/12/2013. Todo el documento. * |
Also Published As
Publication number | Publication date |
---|---|
ES2552711B2 (es) | 2016-11-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108986526A (zh) | 一种基于视觉传感跟踪车辆的智能停车方法及*** | |
US10053090B2 (en) | Method for providing user-defined customization of a vehicle | |
US9567008B2 (en) | Display device for a vehicle for indicating upcoming automatically performed steering interventions in a vehicle | |
CN102192756B (zh) | 道路形状学习设备 | |
CN106134434B (zh) | 一种用于车载导航定位***位置误差修正的轨迹匹配方法 | |
WO2007012199A3 (en) | Traffic management system for a passageway environment | |
CN108140316A (zh) | 行驶控制方法及行驶控制装置 | |
CN109387213A (zh) | 基于混乱评估的自主车辆路由 | |
WO2017189070A3 (en) | Unmanned or optionally manned vehicle, system and methods for determining positional information of unmanned or optionally manned vehicles | |
CN105612403A (zh) | 车辆用行驶引导装置以及方法 | |
CN108646752A (zh) | 自动驾驶***的控制方法及装置 | |
US20100088002A1 (en) | System for increasing fuel economy in vehicles | |
CN104512354A (zh) | 使用增强现实的车辆用平视显示装置 | |
CN103597318A (zh) | 车辆导航*** | |
CN102687181B (zh) | 信号机循环推断装置和信号机循环推断方法 | |
CN114861514A (zh) | 一种车辆行驶方案的规划方法、装置和存储介质 | |
CN109927721A (zh) | 车道维持追随*** | |
CN108255173A (zh) | 机器人跟随避障方法及装置 | |
CN101981604A (zh) | 信号交叉口信息获取装置、信号交叉口信息获取方法以及信号交叉口信息获取程序 | |
ES2552711A1 (es) | Procedimiento de caracterización de trayectorias encarriladas desconocidas recorridas por un móvil, y dispositivo utilizado | |
CN107861502A (zh) | 一种智能控制的无人汽车 | |
Aleko et al. | An IoT enabled traffic light controllers synchronization method for road traffic congestion mitigation | |
KR20190059194A (ko) | 보행자의 차도 인접거리를 기반으로 시각적 경고를 생성하는 보행자 경고 시스템 | |
CN108269400A (zh) | 一种主干路信号控制交叉口延误估算方法及装置 | |
ES2291492T3 (es) | Sistemas de guia de la trayectoria para un paracaidas o planeador para la planificacion del empleo de al menos un paracaidas o planeador, asi como procedimiento para llevar a cabo la guia de la trayectoria y la planificacion. |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FG2A | Definitive protection |
Ref document number: 2552711 Country of ref document: ES Kind code of ref document: B2 Effective date: 20161108 |
|
FD2A | Announcement of lapse in spain |
Effective date: 20210915 |