Day 12
From Bambi
LOG
- Fixed path sampling algorithm in trajectory generator
- Implemented Velocity and Yaw generation
- Statemachine LOGGING
- Implemented MISSION timer
- Notice that the behaviour is predictable, but the version we did not prefer, but predictable (makes first climb to ortophoto altitude and then to the position)