represents the frame of -th gate of the track.
Local -axis marks the side where a the drone should enter from. Bezier anchor points are placed in order, where is a constant:
- for entering point
- in the frame
- for exiting point
Aim is to minimise the constant to reduce time spent in straight line travelling through the gate, while ensuring no collisions happen.
Points in the path are stored in the following structure for an gate track, where is the anchor point, and is the control point for the -th point, and there are three of these for each7 -th gate:
0 & 1 & 2 & 3 & 4 & \dots & i & i & i & \dots & n-1 & n \\ A_{0} & C_{0} & C_{1} & A_{1} & C_{1} & \dots & C_{i} & A_{i} & C_{i} & \dots & C_{n} & A_{n} \end{bmatrix}$$ The total number of anchor points is given by $3n-2$