05.01.2015 Views

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

SHOW MORE
SHOW LESS

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.

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!