|
Algorithm 5. PAT System: |
|
Pointing and Tracking Algorithm : Takes GPS and IMU data to calculate the required pan and tilt angles, facilitating a direct laser communication pathway between the drone and the ground station. |
|
Input: Drone GPS data, Drone IMU data |
|
Output: Pan & tilt angles for the laser pointing system |
| 1. // Acquire GPS and IMU data from the drone a. DroneGPSData ← GetDroneGPSData() |
| b. DroneIMUData ← GetDroneIMUData() |
| 2. // Find relative position between drone, transmitter & receiver |
| a.
|
| b.
|
| c.
|
| Where:
|