Documente Academic
Documente Profesional
Documente Cultură
2. Diagramas Conceptuales
P á g i n a 3 | 24
2.1. Diagrama de Requerimientos
«requirement» «requirement»
Estructural «requirement» «requirement»
Funcionamiento Mecánico
Chasis Funcionamiento eléctrico
Text= Desplazamiento correcto a lo largo Text= Estructura debe ser capas de
soportar, el propio peso y de los Text= Material que Text= Cuenta con sensores y actuadores para
del sembrío
elementos de potencia, control , y soporte ambientes seguir la trayectoria deseada.
material a sembrar. exteriores. Id=”Req3"
Id=”Req1"
Id=”Req2" Id=”Req2.4"
P á g i n a 4 | 24
2.1. Diagrama de Definición de Bloques
bdd Name
«block»
4..*
«block» Cuerpo/Chasis
Motor 2..4
«block»
«Block» 1..* Encoder
Fuente de poder
Partes «block» «block»
Batería Recargable {2} 1..*
Robot Sembrador Sensor «block»
Valúes Giroscopio
Voltaje: V
Corriente: i
«block»
Acelerometro
1..* 1..*
«block»
Pistón de Inyección
P á g i n a 5 | 24
2.1. Diagrama Interno de Bloques
: Fuente de alimentacion
: Giroscopio
: Acelerómetro :Microcontrolador
: Tolva : Encoder
: Chasis
: Driver Motor
: Estructura
: Ruedas
: Motor DC : Motor DC
:Pistón de Inyección
P á g i n a 6 | 24
2.1. Diagrama Paramétrico
par Name
Fuerza: kg*m/s^2
:Torque
Distancia: m
Joules: N*m
:Energía total
Joules:N*m Joules: N*m
1/2
:Energía
Velocidad: m/s
cinética
Masa: Kg : Potencial
Watt:w
Mecánica
Tiempo: s
:Micro controlador
:Potencia
Potencia:w
:Giroscopio Eléctrica
:Acelerometro
:Encoder
P á g i n a 7 | 24
3. Modelo Dinámico del sistema
P á g i n a 8 | 24
Las ruedas cuentan con “encoder” para detectar la dirección de giro, y posición. Para posteriormente
controlar su velocidad angular, lo que nos permitirá conocer el movimiento del robot, su posición (x,y)
, así como su ángulo de giro respecto a su “centroide”. Como se muestra en la figura 2.
Parámetros Físicos:
M= masa del robot
m= masa de cada rueda.
(x,y)= Variables de posición del centroide de masa del robot
𝜑 = Angulo entre la dirección de movimiento del robot y el eje X
Figura 3. Representación de las variables en el plano
3.1. Diagrama Cinemático
Las ecuaciones cinemáticas son aquellas que relacionan la velocidad de giro de cada una de las
ruedas con las variables de la posición del robot: (x, y, 𝜑 ).
𝑟(∅̇ 1 +∅2̇ )
𝑣= (1)
2
𝑑𝑒𝑠𝑝𝑙𝑎𝑧𝑎𝑚𝑖𝑒𝑛𝑡𝑜 𝑟𝑢𝑒𝑑𝑎𝑠:
𝑖𝑧𝑞𝑢𝑖𝑒𝑟𝑑𝑎 𝑆2 = 𝑟. ∆∅2̇ = 𝑥. ∆𝜑 (3.1)
𝑑𝑒𝑟𝑒𝑐ℎ𝑎 𝑆1 = 𝑟. ∆∅1̇ = (𝑥 + 𝑏). ∆𝜑 (3.2)
P á g i n a 9 | 24
𝑑𝜑 𝑟𝑑(𝛥𝜃1−𝛥𝜃2) ̇ ̇)
𝑟(𝜃1̇−𝜃2
= = 𝜑̇ = (3.3)
𝛥𝑡 𝑏𝑑𝑡 𝑏
Posición absoluta del robot
𝑡
𝑟
𝑥 = 𝑥0 + ∫ 𝑣 𝑑𝑡 = 𝑥0 + ∫ (𝜃1̇ + 𝜃2̇)𝑐𝑜𝑠𝜑𝑑𝑡 (𝟐. 𝟏)
0 2
De las ruedas
𝑡𝑟
𝑦 = 𝑦0 + ∫ 𝑣 𝑑𝑡 = 𝑦0 + ∫0 2 (𝜃1̇ + 𝜃2̇)𝑠𝑒𝑛𝜑𝑑𝑡 (2.2)
𝑡
𝜑(𝑡) = 𝜑0 + ∫0 𝑟/𝑏(𝜃1 ̇ − 𝜃2̇)𝑑𝑡 (2.3) Rotación del cuerpo
𝐿 =𝑇−𝑉 (5)
Donde:
T [Energía Cinética]
V [Energía Potencia]
El sistema se simplifica gracias a que la altura del robot es la misma en todo momento, la energía
potencial permanece constante reduciendo la suma de la energía cinética del cuerpo(TC) de cada
rueda (T1 y T2)
Energía Cinética= 𝑇 = 𝑇𝑐 + 𝑇𝑟1 + 𝑇2 (6)
Dado que la energía cinética del cuerpo del robot está dada por la suma de la energía cinética
debido a la translación del cuerpo (asociado a la velocidad lineal) y la energía cinética de la
rotación (asociada a la velocidad angular).
𝐼 = 1/2(𝑚. 𝑟 2 )
𝐼𝑟1 = 𝐼𝑟2 (6)
donde:
1 1 1 2
𝑇𝑟1 = 2 (𝐼𝑟1𝜃1̇ ) = ( 𝑚 ∗ 𝑟 2 ) ∗ ∅1̇ (6 en 7)
2 2
1 2
𝑇𝑟1 = 4 𝑚𝑟 2 ∗ ∅1̇ (9)
P á g i n a 10 | 24
1 1 1 2
𝑇𝑟2 = 2 (𝐼𝑟2𝜃2̇ ) = ( 𝑚 ∗ 𝑟 2 ) ∗ ∅2̇ (6 en 7)
2 2
1 2
𝑇𝑟1 = 4 𝑚𝑟 2 ∗ ∅2̇ (10)
3.1. Lagrange
𝐿 = 𝐾 − 𝑈 (12)
T=L=
3
𝑀𝑟 2
(∅ 2
+ ̇ ∅ ̇ ∅ ̇ + ∅2̇ ) + 1 𝑚𝑟 2 ∗ ∅ ̇ 2 + 1 2
𝑚𝑟 2 ∗ ∅2̇ (8,9,10,11 en 12)
16 1 1 2 2 4 1 4
3 3 𝑀𝑟 2
𝐿 = 16 𝑟 2 (𝑀 + 4𝑚)𝜃1̇2 + 16 𝑟 2 (𝑀 + 4𝑚)𝜃2̇2 + 3 8 𝜃1̇. 𝜃2̇ (13)
τ es un vector con los torques de cada rueda al calcular las derivadas del sistema se obtienen las ecuaciones
dinámicas
𝑑 𝜕𝐿 𝜕𝐿
( )− = 𝜏1
̇
𝑑𝑡 𝜕𝜃1 𝜕𝜃1
𝑑 𝜕𝐿 𝜕𝐿
( )− = 𝜏2
𝑑𝑡 𝜕𝜃2̇ 𝜕𝜃2
𝑑 𝜕𝐿 3 3
𝜏1 = 𝑑𝑡 (𝜕𝜃1̇) = 8 𝑟 2 (𝑀 + 4𝑚)𝜃1̈ + 8 𝑀𝑟 2 𝜃2̈ (14)
𝑑 𝜕𝐿 3 3
𝜏2 = ( ) = 𝑟 2 (𝑀 + 4𝑚)𝜃2̈ + 𝑀𝑟 2 𝜃1̈ (15)
𝑑𝑡 𝜕𝜃2̇ 8 8
3 2 3
𝜏1 𝑟 (𝑀 + 4𝑚) 𝑀𝑟 2 ̈
[ ]=[ 3
8
3 2
8
] [𝜃1] (16)
𝜏2
8
𝑀𝑟 2
8
𝑟 (𝑀 + 4𝑚) 𝜃2̈
4. Modelo
M = 31 kg,
m = 1kg
r = 0.05 m
b=0.40 m
Donde:
M= peso del cuerpo del robot
m= peso de las ruedas
r= radio de las llantas
𝜏1 0.0328 0.029 ̈
[ ]=[ ] [𝜃1] (17)
𝜏2 0.029 0.0328 𝜃2̈
̈ 143.21 − 127.06 𝜏1
[𝜃1] = [ ] [ ] (18)
𝜃2 ̈ −127.06 143.21 𝜏2
Un sistema es lineal (L) si satisface el principio de superposición, que engloba las propiedades de
proporcionalidad o escalado y aditividad. Que sea proporcional significa que cuando la entrada de
P á g i n a 11 | 24
un sistema es multiplicada por un factor, la salida del sistema también será multiplicada por el mismo
factor.. Modelo de espacio de estados:
La linealización Entrada/Salida (E/S), dentro del marco teórico del control geométrico, es una técnica
madura para sistemas no lineales afines. Esta técnica cancela los términos no lineales de la planta,
usando una retroalimentación de estado no lineal, y produce una dinámica E/S lineal para la planta.
𝜃1̇ 143.21
𝐻1(𝑠) = =
𝜏1 𝑠
𝜃2̇ −127.06
𝐻2(𝑠) = =
𝜏1 𝑠
6. SISTEMA DE CONTROL
El modelo del motor DC es el mismo de la Figura 5, que entregarán el torque necesario (1, 2)
Se colocará un PID que controle el voltaje Vin del motor en función del error de velocidad angular de
rueda. El error de velocidad angular de las ruedas se obtiene midiendo la velocidad de las ruedas y
la velocidad deseada.
2𝑣 − 𝜑̇ 𝑏
𝜃2̇ =
2𝑟
𝜑̇ 𝑏 +̇ 2𝑣
𝜃1̇ =
2𝑟
P á g i n a 12 | 24
Figura 5. Motor DC
Modelo mecánico:
𝑑2 𝜃𝑚 𝑑𝜃𝑚
𝐽𝑚 ∗ 2
= 𝑇𝑚 − 𝑇𝐿 − 𝐵𝑚 ∗ ; (19)
𝑑𝑡 𝑑𝑡
𝑑𝜃𝑚
𝐸𝑔 = 𝐾𝑏 ∗ = 𝐾𝑏 ∗ 𝜔𝑚; (20)
𝑑𝑡
𝑇𝑚 = 𝐾𝑚 ∗ 𝑖𝑎; (21)
De donde:
𝑉𝑖𝑛(𝑠) − 𝐾𝑏 ∗ 𝑠 ∗ 𝜃𝑚(𝑠)
𝐼𝑎(𝑠) = ; (22)
𝐿𝑡 ∗ 𝑠 + 𝑅𝑡
𝑇𝑚(𝑠) − 𝑇𝐿(𝑠)
𝜃𝑚(𝑠) = ; (24)
𝐽𝑚 ∗ 𝑠 2 + 𝛽𝑚 ∗ 𝑠
P á g i n a 13 | 24
(21) puede relacionarse con la velocidad, así:
𝑇𝑚(𝑠) − 𝑇𝐿(𝑠)
𝜔𝑚(𝑠) = ; (26)
𝐽𝑚 ∗ 𝑠 + 𝛽𝑚
Se puede construir el diagrama de bloques del motor DC de la Figura 6, La entrada de este modelo
son los torques proporcionados por los motores DC que como se muestra en la Figura 63. Los datos
ingresados para el motor DC son genéricos para motores de este tipo, así:
R=1.4
L=0.0001 H
Km=Kb= 0.3
Jm= 0.0002
Bm=0.0015
Función de Transferencia del motor
𝜃𝑚 𝐾𝑚 − 𝑇𝐿
=
𝑉𝑖𝑛 𝐽𝑚 ∗ 𝐿 ∗ 𝑠2 + (𝛽𝑚𝐿 + 𝐽𝑚𝑅) ∗ 𝑠 + (𝐵𝑚 ∗ 𝑅 + 𝐾𝑏 ∗ 𝐾𝑚)
Fr= uN = uMg
Fr=0.3*110*9.8
Fr= 323.4 N
Fr=F
P=(F*v)/3,6=360 W (2motores)
Pmotor=180 W, Tl=(P/(v/3,6r))= 16.2 Nm
P á g i n a 14 | 24
El PI se sintoniza usando la herramienta de Auto Tune de Matlab, los parámetros sintonizados del PI
se observan en la Figura 3.2
Para determinar la posición angular se debe ingresar la posición angular inicial y la posición angular
final se calcula como:
𝑡
𝜑(𝑡) = 𝜑0 + ∫ 𝑟/𝑏(𝜃1 ̇ − 𝜃2̇)𝑑𝑡
0
𝜑̇ = (𝜑𝑓 − 𝜑0 )/𝛥𝑡, el tiempo que se demora en realizar cualquier vuelta se determina en 10s.
𝜑̇ = (𝜑𝑓 − 𝜑0 )/𝛥𝑡
2𝑣−𝜑̇𝑏
𝜃2̇ = 2𝑟
𝜑̇ 𝑏 +̇ 2𝑣
𝜃1̇ =
2𝑟
P á g i n a 15 | 24
̈ 143.21 − 127.06 𝜏1
[𝜃1] = [ ][ ] (18)
𝜃2̈ −127.06 143.21 𝜏2
𝑡
𝜑(𝑡) = 𝜑0 + ∫ 𝑟/𝑏(𝜃1 ̇ − 𝜃2̇)𝑑𝑡
0
𝑣 = 𝑟/2(𝜃1̇ + 𝜃2̇)
Criterios de Estabilidad
7. Retrato de la Fase
Se puede apreciar que para la respuesta de frecuencia de la velocidad angular 1 𝜃1̇ (rueda 1) el
margen de estabilidad es 155 grados que esta dentro del criterio de estabilidad de margen de fase
de 180 grados, por lo que el sistema es estable. La frecuencia critica de estabilidad es 2.3 rad/s que
significan que ante una señal de entrada cuya frecuencia sea menor a la anterior el sistema seguirá
siendo estable.
P á g i n a 16 | 24
8. Diagramas de Bode
P á g i n a 17 | 24
Sistema de Control
La grafica está el valor deseado en 1 en función del tiempo, esto quiere decir que tiene un sobre paso
de 4.89 porciento y que el tiempo de estabilización de la velocidad angular de la rueda 1 𝜃1̇ es de
0.25s.
P á g i n a 18 | 24
10. Posición
P á g i n a 19 | 24
Cinética del movimiento. - se encarga de dar velocidad angular a las ruedas para que giren
P á g i n a 20 | 24
11. Control de motores:
Entradas:
P á g i n a 21 | 24
Giro Horario
P á g i n a 22 | 24
14. Conclusiones:
• A lo largo del proyecto se utilizó una serie de apartados que describen el sistema de control
de posición.
• Se determino por utilizar métodos geométricos para realizar el control de posición. Este
método utiliza el calculo del radio de curvatura para hacer el seguimiento de una trayectoria deseada.
• Los softwares utilizados como ayuda para realizar y para la simulación del proyecto son de
gran importancia ya que se puede obtener la respuesta del sistema sin que este esté creado
físicamente y mediante las ecuaciones de estado se pueden realizar de forma más rápida y confiable.
P á g i n a 23 | 24
15. Bibliografía
Mecamex.net. (2017). Citar un sitio web - Cite This For Me. [online] Available at:
http://www.mecamex.net/anterior/cong06/articulos/60704final.pdf [Accessed 11 Dec. 2017].
P á g i n a 24 | 24