Changed types of x,y,angles in WayPoint