Moved OpenCV functions into their own file, Added namespaces for the source files, Moved path follower into its own class, Adjusted distance calculation in path follower for altitude, Made common functions inline