The copter should head in the right direction now.

Yeah, it should go towards the waypoint, rather than away from it.