github-mirrors/3lips
1
0
Fork 0
mirror of https://github.com/30hours/3lips.git synced 2024-11-18 12:33:58 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

Ellipse working

Browse source
This commit is contained in:
30hours 2024-03-06 10:31:32 +00:00
parent 90694e6758
commit bb6ef6166d
2 changed files with 4 additions and 10 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

10
event/algorithm/localisation/EllipseParametric.py
View file

@ -145,16 +145,10 @@ class EllipseParametric:
for i in range(len(r_1)):
# points to ECEF
x, y, z = Geometry.enu2ecef(
r_1[i][0], r_1[i][1], 0,
r_1[i][0], r_1[i][1], 100,
ellipsoid.midpoint_lla[0],
ellipsoid.midpoint_lla[1],
ellipsoid.midpoint_lla[2])
# points to LLA
[x, y, z] = Geometry.ecef2lla(x, y, z)
# only store points above ground
if z > 0:
# convert back to ECEF for simple distance measurements
[x, y, z] = Geometry.lla2ecef(x, y, z)
output.append([round(x, 3), round(y, 3), 0])
output.append([x, y, z])
return output

4
event/event.py
View file

@ -149,10 +149,10 @@ async def event():
[x_rx, y_rx, z_rx],
radar["radar"]
)
points = ellipsoidParametric.sample(ellipsoid, radar["delay"]*1000, 50)
points = localisation.sample(ellipsoid, radar["delay"]*1000, 50)
for i in range(len(points)):
lat, lon, alt = Geometry.ecef2lla(points[i][0], points[i][1], points[i][2])
points[i] = ([round(lat, 3), round(lon, 3), round(alt)])
points[i] = ([round(lat, 3), round(lon, 3), 0])
ellipsoids[radar["radar"]] = points
# output data to API