mate problem parallax propeller
Postat: 22 december 2007, 22:10:10
Hej!
Skall räkna ut kuren till en waypoint och har letat länge nu men jag har hittat något:
(Från DynamicMathLib.spin)
men när jag kör koden:
Står det: "Kurs: 1127481344"
(Positionerna ligger precis under varandra bör bli 180grader?)
Men det är väll inte i grader?
Skall räkna ut kuren till en waypoint och har letat länge nu men jag har hittat något:
Kod: Markera allt
pub CorrectedCoordsToDegs(lon1, lat1, lon2, lat2) | factlat, factlon, latavg, lala, lolo
latavg := fdiv(fadd(lat1, lat2),2.0) ' if we were doing great-circle distance, we would need to solve an integral here. let's not and say we did
factlat := LatMeters(latavg)
factlon := LonMeters(latavg)
lala := fmul(factlat,fsub(lat2,lat1))
lolo := fmul(factlon,fsub(lon2,lon1))
' special case in which arctan fails
if (lolo == 0.0 and fcmp(lala, 0.0) < 0)
return 180.0
' theta := fround(fmul(degrees(atan2(xx,yy)),10.0))
return atan2D(lolo,lala)
men när jag kör koden:
Kod: Markera allt
text.str((string("Kurs: ")))
text.dec(math.CorrectedCoordsToDegs(01332.656, 5717.4828, 01332.656, 5717.3049) )
text.out(13)
(Positionerna ligger precis under varandra bör bli 180grader?)
Men det är väll inte i grader?