R/C coche equilibrio Robot (4 / 7 paso)

Paso 4: Código de Arduino para el equilibrio invertido sobre el terreno

Lo que sé, un péndulo invertido se logra controlando el par de motor conducción en la ecuación de Lagrange. Par del motor se puede controlar por una corriente al motor o una aceleración angular del motor.

En este proyecto se aplican control actual del motor.

Corriente para el equilibrio invertido del motor requerida se calcula como fórmula siguiente;

iValue = K1 * theta + K2 * phi + K3 * dtheta + K4 * dphi

iValue: requied corriente del motor (A)

Theta: ángulo de la rueda (rad)---calculado por integración de dtheta

Phi: ángulo (rad) – del cuerpo---obtenida del sensor de MPU6050

dTHETA: rueda velocidad angular (rad/seg)---Estimado usando el valor medido y el valor PWM

dphi: cuerpo velocidad angular (rad/seg)---computado por la diferenciación de phi

K1, K2, K3, K4: ganancias (estas cifras pueden encontrarse por prueba y error).

(Theta y dtheta Estimado son inexactos, pero éstos están trabajando en este proyecto).

Control de corriente directa es difícil. Por lo tanto, me mida al motor (iCurrent) y basado en error (iValue – iCurrent) alimentación proporcionalmente a valor PWM al motor con filtro de paso bajo.

Estos arriba mencionados se resumen a continuación;

flotador de K1, K2, K3, K4;

flotador dtheta, phi, theta, dphi;

iValue flotador, iCurrent, iError;

flotador Ka;

iMotor de flotador;

void loop()

{

iValue = K1 * theta + K2 * phi + K3 * dtheta + K4 * dphi;

iError = iValue - iCurrent;

iMotor = suave (Ka * iError, 0.05, iMotor);

MotorDrive(iMotor);

}

En-el-lugar-equilibrio no es tan divertido!

R/C coche debe ser remota controlada.

Luego, hacer control remoto!

Artículos Relacionados

Uno mismo-equilibrio Robot

Uno mismo-equilibrio Robot

En primer lugar que quiero pedir disculpas por mi inglés, si no entiendes algo, por favor, pregunte.Sé que una robusteza uno mismo-equilibrio no es nueva, pero cuando empecé este proyecto me encontré con un montón de información, pero nunca en el mis
SainSmart InstaBots Rover vertical (uno mismo-equilibrio Robot con Arduino)

SainSmart InstaBots Rover vertical (uno mismo-equilibrio Robot con Arduino)

Rover vertical es una robusteza uno mismo-equilibrio que fue diseñada por SainSmart. Realmente hicieron simple. Como se puede ver, sólo hay 8 alambres en el robot y 8 alambres en el controlador. Así que vamos a averiguar cómo funciona!PIEZAS DE LA CA
Hacer una calabaza de Halloween por uno mismo-equilibrio Robot

Hacer una calabaza de Halloween por uno mismo-equilibrio Robot

Calabaza es un símbolo típico de Halloween. Que siempre quisiste hacer una calabaza de a pie.Aquí les mostraré mi trabajo de utilizar un Robot de Self-balancing para moverse una calabaza brillante.Paso 1: preparación Lista de materiales principales:1
Coche RC robot evitando obstáculo

Coche RC robot evitando obstáculo

este es el coche antiguo.Encuentro un viejo coche de RC en mi galpón.¿Cómo me convertido en un robot? Es sencillo, que te explico en el siguiente paso.Paso 1: El viejo coche del RC 1. quitar la carcasa2 quitar el circuito.Paso 2: Control Control util
Cómo hacer un Robot bola de equilibrio

Cómo hacer un Robot bola de equilibrio

el año pasado, he hecho esta bola equilibrio robot. Puede colocarse en una bola estable por el sistema de equilibrio de sí mismo.Sólo hay un conecte entre el robot y el suelo, por lo que es más flexible que el tradicional robot con ruedas. Puede move
Hacer un Robot con Arduino UNO de uno mismo-equilibrio

Hacer un Robot con Arduino UNO de uno mismo-equilibrio

Uno mismo-equilibrio Robot es muy interesante. Muchos amigos que nos rodean estaban tratando de hacer uno, pero encounted muchos desafíos, incluyendo la falta de las estructuras de fácil montaje, los circuitos electrónicos adecuados y los programas.
Equilibrio Instructable Robot

Equilibrio Instructable Robot

En este Instructable quería mostrar cómo hacer un self balancing robot. Lo que la hace única es que su exterior es como el Instructables Robot. Internamente trabaja en el principio de la PID, es un sistema de control muy popular para mantener una var
B-robot EVO. El self balancing robot

B-robot EVO. El self balancing robot

¿Cómo funciona?B-ROBOT es un equilibrio de arduino robot creado con piezas impresas 3D controlado remotamente. Con sólo dos ruedas, B-ROBOT es capaz de mantener su equilibrio todo el tiempo usando sus sensores internos y conducir los motores. Puede c
Sin embargo, otra línea siguiente / obstáculo evitación 2WD coche

Sin embargo, otra línea siguiente / obstáculo evitación 2WD coche

Este coche de robot no es nada nuevo. Instructables y Youtube se sazonan con pimienta con un coche robot similar a este y sinceramente esos anuncios me inspiraban a armar este kit de robótica asequible que podría folleto en mi taller de robótica (niv
4WD todo terreno Arduino Robot para todos

4WD todo terreno Arduino Robot para todos

Siempre me ha gustado robots que pueden moverse en terrenos ásperos. Esta vez he decidido que voy a utilizar chasis confeccionado modificarlo un poco y añadiendo unos pocos componentes adicionales. Mediante el uso de un chasis listo rápidamente podrí
Cómo utilizar un dispositivo Android y Lego NXT para construir un Robot de dos ruedas Self-Balancing

Cómo utilizar un dispositivo Android y Lego NXT para construir un Robot de dos ruedas Self-Balancing

Hoy, te enseñaré cómo hacer un Android accionado y controlado dos ruedas uno mismo-equilibrio robot con Lego NXT.En primer lugar, vamos a ver un video de prueba para el robot final.Aquí está otra prueba en la cuesta:Para construir este robot, todo lo
ESTRUCTURA de encargo 4WD BLUETOOTH RC ROBOT utilizando PVC

ESTRUCTURA de encargo 4WD BLUETOOTH RC ROBOT utilizando PVC

Hola chicos este es mi segundo proyecto hecho por el pvc, se preguntará por qué elegir pvs a mis proyectos, tengo montón de pvc que son las sobras de mi casa, instrumentos de trabajo y no quiero perderlos coz.DETALLES DEL PROYECTOSe trata de un simpl
Otro más fácil invertido péndulo Robot

Otro más fácil invertido péndulo Robot

Se trata de una versión mejorada de mi anterior instructivo titulado "Un Simple y muy fácil invertido péndulo equilibrio Robot". Existen cuatro ventajas en esta versión.Más fácil conseguir un materialMenos materiales necesariosPrograma sencillo
Chappie-Self-Balancing robot

Chappie-Self-Balancing robot

Después de conseguir tanto frustrado sobre PID Sintonía de quadcopter, decidí dominar PID primero en algunos proyecto básico. Uno mismo-equilibrio robot parece una opción ociosa. Puesto que no es nuevo y aún desafiante, decidí ir a por ello.Nunca pen