- double halfLengthMetres = lengthM() * 0.5;
-
- SGGeodesy::direct(mPosition, _heading,
- aOffset - halfLengthMetres,
+
+ SGGeodesy::direct(geod(), _heading, aOffset, temp, dummyAz2);
+
+ SGGeodesy::direct(temp, SGMiscd::normalizePeriodic(0, 360,_heading+90.0),
+ lateralOffset,