added asymmetric gains on MedianPID; various other changes for stable waypoint following