Adquiriendo señal…
Adquiriendo señal…
Lección 8 de 12· Control y estimación
0 de 12 lecciones · 0 %
En Sistemas APT (lección 3, «Geometría del pase: ventanas, máscara de elevación y keyhole») el keyhole aparece como una singularidad de la montura acimut-elevación: cerca del cénit, un pequeño desplazamiento del satélite exige un giro enorme del acimut. En Mecánica Orbital (lección 8, «Del TLE al pase») se calcula la geometría del pase. Esta lección pone números de ingeniero a la singularidad y la resuelve de dos maneras que la Estación implementa y mide: planificando la referencia (keyhole.py, docs/SEGUIDOR.md §3–§4) y con control predictivo (mpc.py, mpc_controller.py, docs/MPC.md), un controlador que conoce la efeméride futura y respeta los límites de la montura dentro del propio problema.
Modelo de tierra plana cerca del cénit: el satélite vuela en línea recta a altura con velocidad , y en su punto más cercano pasa a una distancia horizontal de la estación. La elevación máxima cumple , así que
Paso 1: el acimut. Tomando en la culminación y el eje hacia el punto de máxima aproximación, la proyección del satélite sobre el suelo es y su acimut es .
Paso 2: la velocidad. Con y :
que es máxima en , la culminación:
Paso 3: la aceleración. Derivando otra vez, . Para su máximo buscamos el de :
y por tanto, segundos antes y después de la culminación,
Ejemplo con los valores del laboratorio. A 400 km la velocidad circular es km/s.
Son exactamente las cifras de docs/HARDWARE.md §2.1, que las calcula con la órbita esférica y valida contra SGP4: 21.0 °/s y 5.0 °/s² a 87°, 63 °/s y 45 °/s² a 89°. Con 85° el modelo plano da 12.56 °/s y 1.79 °/s², las mismas dos cifras de su tabla. La elevación, en cambio, nunca pide más de : 1.1 °/s en el cénit. Todo el problema es del acimut.
Invirtiendo la fórmula, un rotor de velocidad máxima satura en los pases con . Para un rotor tipo Yaesu G-5500 de 6 °/s a 550 km ( km/s): , . La estadística de pases de docs/HARDWARE.md §2.2 dice que ese rotor pierde el 3.2 % de los pases a 550 km; uno de 20 °/s satura en 87.7° y pierde el 1.0 %. Ninguna clase de motor llega al cénit exacto: la demanda diverge.
Pero saturar no es salirse del haz. Cerca del cénit un error de acimut vale en el cielo : la montura puede ir muchos grados atrasada en acimut sin que el haz lo note. Por eso la pérdida empieza más arriba que la saturación: con la estrategia ingenua, en banda S a partir de 85° (docs/SEGUIDOR.md §4.4).
Son un parámetro del generador de referencia (keyhole:= en atp_loop.launch.py):
ingenua: la orden es la dirección del satélite; la montura la sigue y satura.anticipada: el acimut empieza a girar antes de la culminación, con la trayectoria que minimiza el error máximo en el cielo bajo topes de velocidad y aceleración. Es un programa lineal: sujeto a , y los topes, resuelto con HiGHS en una rejilla de 0.25 s. Como , su es una cota inferior de lo que logra cualquier controlador con esos topes.sobre_cenit: con una montura que llegue a 180° de elevación, la elevación pasa por encima del cénit y el acimut no gira; el error queda acotado por la distancia al cénit, .Resultados medidos en lockstep, pase sintético de 550 km con rotor de 6 °/s (docs/SEGUIDOR.md §4.2):
| el máx | ingenua (rms / máx) | anticipada (rms / máx) | sobre el cénit (rms / máx) |
|---|---|---|---|
| 85° | 0.285° / 1.90° | 0.119° / 0.98° | 0.119° / 0.98° |
| 88° | 0.939° / 7.01° | 0.434° / 2.93° | 0.434° / 2.93° |
| 89.9° | 2.496° / 15.75° | 0.726° / 4.52° | 0.009° / 0.16° |
A 85° y 88° sobre_cenit elige seguir directo (cruzar costaría más que el atraso), por eso coincide con la anticipada; a 89.9° cruza y el error cae a 0.16°.
El planificador corre aparte del lazo. El MPC lo mete dentro: en cada paso de 50 ms resuelve, por eje, un problema cuadrático sobre un horizonte futuro, con la efeméride futura como dato y los límites como restricciones duras. El modelo y el costo son los del LQR integral de la lección 6:
donde mete la referencia futura exacta como un residuo conocido, es la solución de la DARE del LQR integral, y los pesos son los mismos (, , , ). Tres decisiones de diseño importan:
mpc_sky): y del acimut se multiplican por de la referencia futura. El MPC «sabe» que cerca del cénit el atraso de acimut no cuesta, sin planificador externo.5x0.05,5x0.1,10x0.5,10x1.0,10x2.0 son 35 pasos que ven 35.75 s hacia adelante; pasos cortos al principio y largos al final.La efeméride futura viaja en una interfaz propia, con el mismo sello que /atp/reference:
# src/atp_interfaces/msg/ReferenceHorizon.msg
std_msgs/Header header
float64[] t_s # instantes (s) desde el sello; crecientes, t_s[0] = 0
float64[] az_rad # acimut (continuo) en cada instante
float64[] el_rad
float64[] vaz_rad_s # derivada de la referencia (de la efemeride)
float64[] vel_rad_s
# src/atp_ros/atp_ros/mpc_controller.py (recortado)
self.create_subscription(ReferenceHorizon, '/atp/reference_horizon', self.on_ref, 10)
self.create_subscription(JointState, '/joint_states', self.on_meas, 10)
self.pub = self.create_publisher(JointState, '/atp/torque', 10)
def on_ref(self, msg):
"""La referencia que se empareja por sello es el horizonte completo."""
s = _sello(msg)
tau = np.array(msg.t_s)
r = np.stack([msg.az_rad, msg.el_rad], axis=1)
v = np.stack([msg.vaz_rad_s, msg.vel_rad_s], axis=1)
self.refs[s] = (tau, r, v)
# keyhole sin planificador externo: horizonte largo, topes del rotor, peso de cielo
ros2 launch atp_ros atp_loop.launch.py el_max:=89.9 mask:=60 vel_max:=6 pass_n:=12000 \
time_scale:=0 controller:=mpc mpc_horizon:=5x0.05,5x0.1,10x0.5,10x1.0,10x2.0 \
mpc_sky:=true mpc_acel:=20 error_esferico:=true
Supongamos que ninguna restricción está activa, horizonte uniforme con y costo terminal , la solución de la DARE. El problema del MPC es entonces un LQR de horizonte finito con costo de llegada , y se resuelve exactamente con la recursión de Bellman de la lección 6, hacia atrás desde el final:
Pero es, por definición, el punto fijo de la recursión: . Por inducción hacia atrás, para todo , y la ganancia del primer mando es
para cualquier , incluso . El término de pre-alimentación y el residuo solo desplazan el óptimo sin cambiar la ganancia.
La Estación lo comprueba: la ganancia efectiva del MPC coincide con a con , y en lazo cerrado la secuencia de mandos del MPC y la del LazoLQR coinciden a N·m durante 80 pasos (docs/MPC.md §4.1). Sin el costo terminal () la igualdad solo llega en el límite, y despacio por el polo lento del integrador: con (0.5 s) la ganancia es ; hacen falta 320 pasos (16 s) para igualar al LQR a la centésima. Moraleja: en la escalera conocida el MPC no mejora al LQR + Kalman, lo iguala (N2: 0.0025° contra 0.0020°; N4b: 0.0730° los dos). Su valor aparece cuando las restricciones se activan.
¿Por qué el MPC de la Estación, sin restricciones activas, da exactamente la ganancia del LQR para cualquier horizonte?
Pase sintético de 550 km, rotor de 6 °/s y 20 °/s², sin planificador externo: el MPC recibe la referencia ingenua y la efeméride futura (docs/MPC.md §4.2 y §5.2). Su error máximo queda a 1–7 % de la cota del programa lineal: 0.959° contra 0.918° a 85°, 2.902° contra 2.875° a 88°. Y lo hace sin forzar la montura: a 85° el PID ingenuo pasa 17.5 s con la planta topada en velocidad y 1.89 N·m de par rms; el MPC, 0.0 s y 0.03 N·m. El horizonte importa: con solo 2 s el MPC no ve venir el giro y a 85° vuelve a 1.92° de error máximo; sin peso de cielo, a 89.5°, sube de 4.24° a 7.15°.
El costo de cómputo cabe: con el horizonte no uniforme de 35 pasos, en Python, la mediana es 6.2 ms por paso con restricciones activas, el p99 22.5 ms y el máximo 35 ms, dentro de los 50 ms del periodo (docs/MPC.md §7.1). Horizontes uniformes de 60–80 pasos llegan a 150 ms y no caben a 20 Hz. En el ESP32 a 1 kHz no cabe ni con un ADMM de iteraciones fijas (1.7–2.9 ms estimados por paso): la arquitectura propuesta es el MPC en el PC a 20 Hz y el lazo de 1 kHz en el microcontrolador.
El programa calcula la demanda de acimut con el modelo plano y la comprueba derivando numéricamente; da la elevación de saturación de dos rotores; simula un seguidor ideal con tope de velocidad persiguiendo la referencia ingenua (el «analítico» de docs/SEGUIDOR.md §4.5: 1.90°, 6.82° y 14.60°); y reproduce la tabla de docs/MPC.md §4.1: la ganancia del primer mando del MPC sin restricciones con y sin costo terminal.
La salida esperada: 12.56 °/s y 1.79 °/s² a 85°, 20.96 °/s y 4.98 °/s² a 87°, 62.94 °/s y 44.91 °/s² a 89°, con la derivada numérica en 20.96 y 4.98; saturación en 82.5° (6 °/s) y 87.7° (20 °/s); errores de la ingenua de 1.91°, 6.83° y 14.65°, a menos de 0.5 % del analítico del repositorio; y en el caso del laboratorio, 87° a 400 km con 20 °/s, apenas 0.04°, porque la demanda de 21 °/s casi cabe. La tabla final muestra la ganancia con clavada en para todo , y con pasando por en hasta igualarla en .
El laboratorio Keyhole y MPC arranca en «Pase de 87° a 400 km»: la lectura de máx pedida debe marcar unos 21 °/s y la de aceleración unos 5 °/s², por encima y por debajo, respectivamente, de los topes por defecto de 20 °/s y 10 °/s². Con la estrategia ingenua la escena de velocidad toca la banda del límite durante un instante y el error máximo es pequeño. Elige «Pase de 89°» y la demanda salta a 63 °/s: la carta polar muestra la montura quedándose atrás en acimut mientras la elevación sigue bien. Cambia la estrategia a anticipada y verás el acimut empezar a girar antes de la culminación; prueba MPC y mueve el horizonte del MPC de 3 s a 0.5 s: con un horizonte corto el MPC deja de anticipar y su error se parece al de la ingenua (en el pase de 89° el error máximo es 2.49° con la ingenua, 1.06° con la anticipada, 1.00° sobre el cénit, y 2.55°, 2.30° y 1.11° con el MPC a 0.5, 3 y 10 s de horizonte). Termina con «Rotor G-5500 (6 °/s) a 550 km» (pase de 85°) y compara el tiempo fuera del haz de las cuatro estrategias: la ingenua llega a 1.85° y la anticipada se queda en 0.93°, las mismas cifras que mide la Estación en docs/SEGUIDOR.md §4.5.
docs/HARDWARE.md §2.1).Con el keyhole resuelto en software, el lazo sigue apuntando con la efeméride: es program track. En la lección 9 cerramos el lazo sobre la propia señal del satélite con el conical scan, y pasamos de 0.16° de error a 0.004°.
Cierre de la lección
Sigue el recorrido de la lección paso a paso.
Con una cuenta desbloqueas el cuestionario, el foro de dudas y el tutor con IA de esta lección, además del registro de progreso y el certificado verificable al terminar «ROS 2 aplicado: la Estación ATP de punta a punta».