Read instructions before using!

Description

This is a simple funky trees system for automatically passing an arbitrary amount of waypoints on the way to the target.
The missile here is just for demonstration. It uses a proximity-derivative detonator (based on this detonator i made earlier) to detonate as close to the target as possible.
The code here is for 2 waypoints (1 intermediate and 1 target), but this amount can easily be increased. The user needs to define coordinates (3 points), add 3 variables (based on existing ones, just change the numbers), and update the pitch and yaw controllers.
Note that this is version 1. It works, but turns somewhat slowly and it is not super precise (good for ground targets but not for moving planes). This will be improved in the future versions.

Instructions

Using the missile in the post is quite simple. Spawn in the air at Wright Final Approach and watch it fly all the way to Bandit Airport to blow up the bridge with great precision. High physics setting is recommended. Also works from Yeager Final Approach, but the missile will make a big U-turn to pass the first waypoint.

When using this in your own missiles or vehicles, you will need to adjust a few things. The yaw and pitch controllers use the atan function with 2 coefficients (4 in total at the bottom of the variable list). The optimal coefficients are unique for each craft, so change them if you experience wobble or slow turns.

How does it work?

The system uses some trigonometry and linear algebra to convert a set of 3 coordinates into distance, heading and elevation of the target point. It then uses the atan function to smootly turn towards the target and fly there. The point is considered passed if the missile reaches within 100m of it.
The proximity-derivative detonator activates when the missile is close to the target AND when the sign of rate(target_distance) flips. This means that it detonates as close as possible, which is useful for air-to-air missiles.