Autor Tema: Robot equilibrista  (Leído 211766 veces)

0 Usuarios y 1 Visitante están viendo este tema.

Desconectado marito

  • PIC16
  • ***
  • Mensajes: 217
Re: Robot equilibrista
« Respuesta #450 en: 28 de Mayo de 2012, 16:07:18 »
Para calcular el angulo mido la velocidad angular con el giróscopo y la multiplico por el tiempo de ciclo de lectura, con eso obtengo la variación del ángulo durante el último ciclo. Integro este valor con el valor medido con el acelerómetro.

Integro un 90% del ángulo medido con el giro y un 10% del valor medido con el acelerómetro.

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #451 en: 28 de Mayo de 2012, 16:11:43 »
supongo que sumas el angulo calculado del giro con el angulo que ya tenias antes, y que pasa con las vibraciones?, no te afectan la medicion del angulo?
"Nada es imposible, no si puedes imaginarlo"

Desconectado marito

  • PIC16
  • ***
  • Mensajes: 217
Re: Robot equilibrista
« Respuesta #452 en: 28 de Mayo de 2012, 16:13:59 »
exacto, hago esa suma  con las lecturas del giroscopo, y elimino la deriva con el acelerómetro.

No observo que las vibraciones afecten el cálculo del ángulo, ya que el giro filtra las mismas

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #453 en: 28 de Mayo de 2012, 16:17:00 »
entonces el problema esta en tu funcion del controlador, para calibrarlo primero calibra el proporcional, solo con este el robot debe ser capaz de mantener el equilibrio, ya despues con los otros haraz mas suave la respuesta del mismo.

una pregunta, cuando tu robot esta en 0° la respuesta de tu controlador si es 0 para el pwm de los motores?
"Nada es imposible, no si puedes imaginarlo"

Desconectado marito

  • PIC16
  • ***
  • Mensajes: 217
Re: Robot equilibrista
« Respuesta #454 en: 28 de Mayo de 2012, 16:21:26 »
Si, cuando el ángulo es 0°, la referencia de velocidad es nula.

Con el control proporcional solo podría lograr el equilibrio?

Porque lo que observo es que se balancea continuamente de un lado a otro hasta que se cae. Creo que puede ser un tema de la aceleración que recibe de un lado a otro que le impide "frenar" cuando pasa por el 0°

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #455 en: 28 de Mayo de 2012, 16:26:00 »
Con el control proporcional solo podría lograr el equilibrio?

Exacto, solo con el proporcional, de hecho, una de las pruebas que hice fue usando un controlador on-off, y con eso fue suficiente para mantenerlo en equilibrio(subi un video, creo que esta unas paginas atras).

como consejo, no se debe de poner la velocidad en 0 solo cuando el angulo es 0, debes tener un pequeño margen, que se detenga entre -1 y 1° por ejemplo
"Nada es imposible, no si puedes imaginarlo"

Desconectado marito

  • PIC16
  • ***
  • Mensajes: 217
Re: Robot equilibrista
« Respuesta #456 en: 28 de Mayo de 2012, 16:30:41 »
bueno, justamente eso que me comentas de una "zona muerta", es lo que estaba pensando en implementar. Lo estaba pensando en usar una ganacia más pequeña. de ese modo evitar que se pase de largo de un lado a otro.

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #457 en: 28 de Mayo de 2012, 16:33:39 »
la ganancia pequeña te podria ayudar, pero aun asi deberia quedarse de pie, si le pones una ganacia muy grande se vuelve un control on-off. es decir, en cuanto pase a un lado se pone a maxima velocidad en esa direccion, aun asi deberia quedarse en pie aunque vibrando mucho.

haz la prueba con la zona muerta, y otr prueba que puede hacer es que tu robot se quede equilibrado solo, debes encontrar un punto donde por su propio peso se quede en equilibrio, y este punto deberia ser 0°
"Nada es imposible, no si puedes imaginarlo"

Desconectado marito

  • PIC16
  • ***
  • Mensajes: 217
Re: Robot equilibrista
« Respuesta #458 en: 28 de Mayo de 2012, 16:45:45 »
buenisimo, voy a hacer esa prueba con la zona muerta

Lo de la ganancia grande, supongo que con mi robot no funciona porque es pesado, y cuando comienza a balancearse es dificil frenarlo

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #459 en: 28 de Mayo de 2012, 16:47:27 »
buenisimo, voy a hacer esa prueba con la zona muerta

Lo de la ganancia grande, supongo que con mi robot no funciona porque es pesado, y cuando comienza a balancearse es dificil frenarlo

 ;-) ;-)
pones un videito para ver a tu robot
"Nada es imposible, no si puedes imaginarlo"

Desconectado gary_servin

  • PIC12
  • **
  • Mensajes: 65
Re: Robot equilibrista
« Respuesta #460 en: 28 de Mayo de 2012, 19:58:27 »
Aquí va un video del robot por el que venimos trabajando hace un tiempo.


Saludos!

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #461 en: 28 de Mayo de 2012, 20:02:47 »
creo que le falta algo de velocidad a los motores para equilibrarlo
es el mismo robot de marito?
"Nada es imposible, no si puedes imaginarlo"

Desconectado gera

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 2188
Re: Robot equilibrista
« Respuesta #462 en: 28 de Mayo de 2012, 20:52:27 »
Me pasa exactamente lo mismo. Yo tambien pense que con motores mas rapidos podria controlarlo, pero no es suficiente. No deberia irse tanto del punto de equilibrio salvo que lo empujes. Para mi es problema de sensado. Corrobora bien que el mismo es rapido y preciso. En mi robot habia un pequeño retraso y eso hacia que no se pueda equilibrar.
Saludos!

"conozco dos cosas infinitas: el universo y la estupidez humana. Y no estoy muy seguro del primero." A.Einstein

Desconectado rivale

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 1707
Re: Robot equilibrista
« Respuesta #463 en: 28 de Mayo de 2012, 20:59:18 »
o su punto de equilibrio no esta en los 0°, parece que esta tirado hacia un lado mas que hacia el otro.

Por cierto como vas con tu robot gera?
"Nada es imposible, no si puedes imaginarlo"

Desconectado gera

  • Colaborador
  • PIC24H
  • *****
  • Mensajes: 2188
Re: Robot equilibrista
« Respuesta #464 en: 28 de Mayo de 2012, 23:56:44 »
Gracias por preguntar!
Mi robot esta en stand by por razones academicas. Estoy trabajando en mi tesis que es un proyecto similar: Un control electronico para un bipedestador movil motorizado, utilizando la misma IMU del robot ;) (es para una niña que tiene paralizadas sus extremidades, y sólo puede mover el torso, por lo tanto uso la IMU para sensar ese movimiento)

Sin embargo hace unas semanas hice un pendulo invertido como el de microchip (app note AN964).
Al utilizar un potenciometro, podemos dejar de lado todo el rollo de sensores y dedicarnos al PID. De entrada tenia un motor muy lento y no podia equilibrarlo. Le puse un motor con menos reduccion y mejoro bastante, pero no se quedaba quieto. Asique pense en implementar un lazo de control extra con encoders. En teoria deberia mejorar bastante, pero no alcance a probarlo.
Cuando retome el proyecto comparto mis resultados ;)

"conozco dos cosas infinitas: el universo y la estupidez humana. Y no estoy muy seguro del primero." A.Einstein


 

anything