[joligario]

Sounds like a Z-axis problem and perhaps the terrain. To start off, you could probably check each waypoint's z coords.