Skip to content

Commit eca3799

Browse files
committed
Documento.
1 parent 53e2569 commit eca3799

12 files changed

+19
-196
lines changed

Diff for: Arduino/CuadricopteroUCAB_VelocidadAngular/CuadricopteroUCAB_VelocidadAngular.ino

+3-2
Original file line numberDiff line numberDiff line change
@@ -483,7 +483,8 @@ void CalcularAltura()
483483
mensajeEstado[8] = estimacionAltura;
484484
U_velocidad_Z = estimacionAltura - U_Z_previo;
485485
U_Z_previo = estimacionAltura;
486-
velocidad_Z = (U_velocidad_Z + A_velocidad_Z)/2;
486+
//velocidad_Z = (U_velocidad_Z + A_velocidad_Z)/2;
487+
velocidad_Z = A_velocidad_Z;
487488
}
488489
tiempoUltimoMuestreoAltura = millis();
489490
}
@@ -919,7 +920,7 @@ void EnviarMensajesTelemetriaPC()
919920
if (millis() - tiempoUltimoEnvio >= DT_envioDatosEstado)
920921
{
921922
PrepararPaqueteMensajeEstado();
922-
Serial.write(mensajeEstado, 14);//ENVIAR EL PAQUETE DE 14 BYTES
923+
Serial.write(mensajeEstado, 15);//ENVIAR EL PAQUETE DE 15 BYTES
923924
tiempoUltimoEnvio = millis();
924925
}
925926
}

Diff for: Documento/Apéndices y anexos.docx

-22.6 KB
Binary file not shown.

Diff for: Documento/Capítulo 2 - Marco Referencial.docx

-23.5 KB
Binary file not shown.

Diff for: Documento/Capítulo 3 - Metodología.docx

-3 Bytes
Binary file not shown.
213 KB
Binary file not shown.
-511 Bytes
Binary file not shown.
Binary file not shown.

Diff for: Documento/SimulacionPID/Altura.fig

1.52 MB
Binary file not shown.

Diff for: Modelo físico/Extendido/Modelo_KivrakExtendido_Param.m

+3-3
Original file line numberDiff line numberDiff line change
@@ -2,9 +2,9 @@
22
Ixx = inercia(1,1)
33
Iyy = inercia(2,2)
44
Izz = inercia(3,3)
5-
Ixx = 0.0142;
6-
Iyy = 0.0142;
7-
Izz = 0.0071;
5+
% Ixx = 0.0142;
6+
% Iyy = 0.0142;
7+
% Izz = 0.0071;
88
longitudEje = 0.47;
99
L = longitudEje/2;
1010
masa = 0.6;

Diff for: Modelo físico/Extendido/Simulacion_KIvrakExtendido_PID_vA_pA_pZ_fM_rVm.m

-175
This file was deleted.

Diff for: Modelo físico/Extendido/Simulacion_KivrakExtendido_PID_vA_pA_vZ_pZ_fM_rVm.m

+12-9
Original file line numberDiff line numberDiff line change
@@ -1,4 +1,4 @@
1-
ControllabilityObservability_KivrakExtendido()
1+
%ControllabilityObservability_KivrakExtendido()
22

33
tF = 20;
44
t = 0:dt:tF;
@@ -10,7 +10,7 @@
1010
fE_pZ = 0.05;
1111

1212

13-
kP_pA = [2.0 2.0 2.0];
13+
kP_pA = [1.0 1.0 1.0];
1414
kI_pA = [0 0 0];
1515
kD_pA = [0 0 0];
1616
pA_deseada = [10 5 16];
@@ -127,7 +127,6 @@
127127
u(4,i) = voltajeMaximoMotores;
128128
end
129129

130-
131130
x_dot(1:numEstados, i) = A*x(1:numEstados, i) + B*u(1:numEntradasControl, i);
132131
x(1:numEstados,i+1) = x(1:numEstados, i) + dt*x_dot(1:numEstados, i);
133132
if (x(10,i+1) < 0)
@@ -136,24 +135,28 @@
136135
end
137136

138137
figure()
138+
subplot(2,2,1)
139139
plot(t,x(1:3,:))
140140
axis([0 tF -100 100])
141141
xlabel('Tiempo (s)')
142142
ylabel('Velocidad angular (grados/s)')
143-
title('Velocidades angulares')
144-
figure()
143+
title('Velocidades angulares en Yaw, Pitch y Roll')
144+
%figure()
145+
subplot(2,2,2)
145146
plot(t,x(4:6,:))
146147
axis([0 tF -20 20])
147148
xlabel('Tiempo (s)')
148149
ylabel('Angulo (grados)')
149150
title('Angulos de Yaw, Pitch y Roll')
150-
figure()
151-
plot(t,x(7:9,:))
151+
%figure()
152+
subplot(2,2,3)
153+
plot(t,x(9,:))
152154
axis([0 tF -20 20])
153155
xlabel('Tiempo (s)')
154156
ylabel('Velocidad (m/s)')
155-
title('Velocidades lineales')
156-
figure()
157+
title('Velocidad lineal en Z')
158+
%figure()
159+
subplot(2,2,4)
157160
plot(t,x(10,:))
158161
axis([0 tF -20 20])
159162
xlabel('Tiempo (s)')

Diff for: ToDo

+1-7
Original file line numberDiff line numberDiff line change
@@ -1,11 +1,5 @@
11
####################################################### ¿Qué falta por hacer? #######################################################
22

33

4-
Sistemas de control (Desde el 23 de octubre)
5-
* Pruebas de vuelo.
64

7-
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
8-
9-
Documento.
10-
* Marco referencial.
11-
* Desarrollo.
5+
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%

0 commit comments

Comments
 (0)