Up to date version of copter system

At least I think it's the most up to date version.  Omid and I have
forked a bit lately.

Also: square.cpp and waypoints.cpp aren't part of the base system.
square.cpp is an example and waypoints.cpp is the waypoints program
(TODO: debug).