|
| 1 | +{ |
| 2 | + "cells": [ |
| 3 | + { |
| 4 | + "cell_type": "code", |
| 5 | + "execution_count": null, |
| 6 | + "id": "d777ed6c", |
| 7 | + "metadata": {}, |
| 8 | + "outputs": [], |
| 9 | + "source": [ |
| 10 | + "%load_ext autoreload\n", |
| 11 | + "%autoreload 2\n", |
| 12 | + "\n", |
| 13 | + "# Get parent directory and add to sys.path\n", |
| 14 | + "import os\n", |
| 15 | + "import sys\n", |
| 16 | + "\n", |
| 17 | + "parent_dir = os.path.dirname(os.getcwd())\n", |
| 18 | + "sys.path.append(parent_dir)\n", |
| 19 | + "\n", |
| 20 | + "# Require ipympl\n", |
| 21 | + "%matplotlib widget " |
| 22 | + ] |
| 23 | + }, |
| 24 | + { |
| 25 | + "cell_type": "code", |
| 26 | + "execution_count": null, |
| 27 | + "id": "c9fb75e7", |
| 28 | + "metadata": {}, |
| 29 | + "outputs": [], |
| 30 | + "source": [ |
| 31 | + "# MPC import\n", |
| 32 | + "from LinearMPC.MPCVelControl import MPCVelControl\n", |
| 33 | + "from PIControl.PIControl import PIControl\n", |
| 34 | + "import numpy as np\n", |
| 35 | + "from src.rocket import Rocket\n", |
| 36 | + "from src.vel_rocket_vis import RocketVis\n", |
| 37 | + "\n", |
| 38 | + "rocket_obj_path = os.path.join(parent_dir, \"Cartoon_rocket.obj\")\n", |
| 39 | + "rocket_params_path = os.path.join(parent_dir, \"rocket.yaml\")" |
| 40 | + ] |
| 41 | + }, |
| 42 | + { |
| 43 | + "cell_type": "code", |
| 44 | + "execution_count": null, |
| 45 | + "id": "494f56e2", |
| 46 | + "metadata": {}, |
| 47 | + "outputs": [], |
| 48 | + "source": [ |
| 49 | + "Ts = 0.05\n", |
| 50 | + "sim_time = 20\n", |
| 51 | + "H = 5.0\n", |
| 52 | + "x0 = np.array([0, 0, 0, 0, 0, 0, 0, 0, 0, 50, 50, 100]) # initial state\n", |
| 53 | + "pos_target = np.array([0, 0, 10.0])\n", |
| 54 | + "\n", |
| 55 | + "rocket = Rocket(Ts=Ts, model_params_filepath=rocket_params_path)\n", |
| 56 | + "pos_controller = PIControl(pos_target)\n", |
| 57 | + "mpc = MPCVelControl().new_controller(rocket, Ts, H)\n", |
| 58 | + "\n", |
| 59 | + "t_cl, x_cl, u_cl, t_ol, x_ol, u_ol, ref = rocket.simulate_control(\n", |
| 60 | + " mpc, sim_time, H, x0, pos_control=pos_controller, method=\"nonlinear\"\n", |
| 61 | + ")\n", |
| 62 | + "\n", |
| 63 | + "vis = RocketVis(rocket, rocket_obj_path)\n", |
| 64 | + "vis.anim_rate = 1.0\n", |
| 65 | + "vis.animate(\n", |
| 66 | + " t_cl[:-1],\n", |
| 67 | + " x_cl[:, :-1],\n", |
| 68 | + " u_cl,\n", |
| 69 | + " Ref=ref[:, :-1],\n", |
| 70 | + " T_ol=t_ol[..., :-1],\n", |
| 71 | + " X_ol=x_ol,\n", |
| 72 | + " U_ol=u_ol,\n", |
| 73 | + ");" |
| 74 | + ] |
| 75 | + } |
| 76 | + ], |
| 77 | + "metadata": { |
| 78 | + "kernelspec": { |
| 79 | + "display_name": "mpc2025", |
| 80 | + "language": "python", |
| 81 | + "name": "python3" |
| 82 | + }, |
| 83 | + "language_info": { |
| 84 | + "codemirror_mode": { |
| 85 | + "name": "ipython", |
| 86 | + "version": 3 |
| 87 | + }, |
| 88 | + "file_extension": ".py", |
| 89 | + "mimetype": "text/x-python", |
| 90 | + "name": "python", |
| 91 | + "nbconvert_exporter": "python", |
| 92 | + "pygments_lexer": "ipython3", |
| 93 | + "version": "3.12.11" |
| 94 | + } |
| 95 | + }, |
| 96 | + "nbformat": 4, |
| 97 | + "nbformat_minor": 5 |
| 98 | +} |
0 commit comments