C'est dommage mais pour que ton truc marche il faut que tu fasses un contrôleur qui prenne en compte les éventuelles perturbations que tu rencontres durant la trajectoire (il y a trop d'inconnus dans ton truc, resistance de l'air, vent etc). Ce qu'il aurait dû faire c'etait intégré un microcontroleur (un arduino par exemple ) couplé d'un IMU et d'une valvle permettant de doser électriquement la pression de ta fusée.
Sur le microcontroleur tu créés un setpoint de ta trajectoire (noublie pas de modeliser la trajectoire en vitesse aussi et si possoble en acceleratation aussi pour avoir un super controleur avec un feed forward) et tu estimes ta position actuelle avec les mesures de ton imu (voir filtre complementaire ou filtre de kalman). Tu n'as plus qu'à faire un controleur pid ou encore mieux un controleur non lineaire mais avec une integrale où le resultat de ce controleur sera le pourcentage de l'ouverture de ta valve.