Finished  Genetic Algorithm

TODO: Add a way to view K value changes.
TODO: Make a better fitness function.

Uncomment region in "FlyToSetPoint" to run the genetic algorithm.