ArduCopter: bug fix to GUIDED mode.  Now checks that desired altitude was reached before deciding the waypoint is complete.