Fixed a bug in the waypoint-container (there is still something wrong there), added animation to the CRS-planner program.