ROBOTS DE EXTERIORES - Centro de Automática y Robótica
ROBOTS DE EXTERIORES - Centro de Automática y Robótica
ROBOTS DE EXTERIORES - Centro de Automática y Robótica
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
Mo<strong>de</strong>lado, Análisis y Construcción <strong>de</strong> una Plataforma Paralela Experimental<br />
para Aterrizaje y Despegue <strong>de</strong> Helicópteros 117<br />
alimentar la información <strong>de</strong> la unidad <strong>de</strong> medida inercia IMU, sea el a<strong>de</strong>cuado.<br />
6.2.1 Sintonización <strong>de</strong> los servomotores eléctricos<br />
Se realizó una subrutina <strong>de</strong> prueba en C para sintonizar el lazo <strong>de</strong> control<br />
<strong>de</strong> posición y se agregó una gráfica en la interfaz para visualizar los resultados.<br />
Esta subrutina manda una señal <strong>de</strong> referencia <strong>de</strong> voltaje al motor,<br />
que sería el error <strong>de</strong> posición o sea la diferencia entre la posición <strong>de</strong>seada y<br />
la posición actual marcada por el encon<strong>de</strong>r (en pulsos), multiplicado por<br />
una ganancia proporcional.<br />
Al inicio todas las ganancias proporcionales son reducidas a lo mínimo.<br />
A continuación se aumenta la ganancia proporcional kp, hasta que el enco<strong>de</strong>r<br />
alcanza la posición <strong>de</strong>seada rápidamente, pero sin causar vibración<br />
al sistema.<br />
Por otra parte el amplificador contiene unos potenciómetros que se <strong>de</strong>ben<br />
ajustar para ajustar las ganancias, entre ellos uno <strong>de</strong> ganancia <strong>de</strong>rivativa<br />
llamada <strong>DE</strong>R y uno <strong>de</strong> ganancia PI llamada Kv, la <strong>DE</strong>R ayuda a amortiguar<br />
la respuesta y la Kv podría mejorar la respuesta en el tiempo. Por<br />
otra parte el amplificador contiene unos potenciómetros que se <strong>de</strong>ben <strong>de</strong><br />
ajustar, entre ellos tiene una ganancia <strong>de</strong>rivativa llamada <strong>DE</strong>R y una ganancia<br />
PI llamada Kv, la <strong>DE</strong>R ayuda a amortiguar la respuesta y la Kv podría<br />
mejorar la respuesta en el tiempo.<br />
6.2.2 Movimiento <strong>de</strong> la plataforma sincronizada con la unidad<br />
<strong>de</strong> medida inercial - IMU<br />
Con el objetivo <strong>de</strong> mantener el efector final <strong>de</strong> la heliplataforma estable en<br />
una posición inicial dada, es necesario medir la inclinación <strong>de</strong> la base <strong>de</strong> la<br />
plataforma Stewart-Gough, el barco, y realimentarla al control <strong>de</strong> posición<br />
<strong>de</strong> la plataforma. Para esto se localiza la unidad <strong>de</strong> medida inercial IMU<br />
sobre la base <strong>de</strong> la plataforma Stewart-Gough.<br />
En una prueba previa se <strong>de</strong>smontan los motores <strong>de</strong> los husillos y se retira<br />
la unidad <strong>de</strong> medida inercial <strong>de</strong> la base <strong>de</strong> la plataforma. Entonces, la<br />
orientación <strong>de</strong> la unidad <strong>de</strong> medida inercial es modificada con la mano y se<br />
observa que el movimiento <strong>de</strong> los ejes <strong>de</strong> los motores eléctricos sea el esperado.<br />
Posteriormente, los motores son montados a los husillos y el efector<br />
<strong>de</strong> la plataforma Stewart es llevado, mediante un planificador, a una<br />
posición <strong>de</strong> inicio (por encima <strong>de</strong> la mitad <strong>de</strong> su carrera), y nuevamente la<br />
orientación <strong>de</strong> la unidad <strong>de</strong> medida inercial es cambiada manualmente, para<br />
verificar el correcto movimiento <strong>de</strong> la plataforma.