Skip to content

Commit 1d6d784

Browse files
author
spencer@primus
committed
Add static ref method
1 parent ca1bd69 commit 1d6d784

File tree

1 file changed

+21
-0
lines changed

1 file changed

+21
-0
lines changed

avstack/geometry/refchoc.py

Lines changed: 21 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -367,6 +367,27 @@ def get_ground_projected_reference(self):
367367
)
368368
return ref_new
369369

370+
def get_static_reference(self):
371+
# integrate reference frame
372+
if self == GlobalOrigin3D:
373+
return self
374+
elif self.reference != GlobalOrigin3D:
375+
ref = self.integrate(start_at=GlobalOrigin3D)
376+
else:
377+
ref = self
378+
379+
# set new reference without velocity
380+
ref_new = ReferenceFrame(
381+
x=ref.x,
382+
q=ref.q,
383+
reference=ref.reference,
384+
from_frame=self.from_frame,
385+
to_frame=self.to_frame + "/static",
386+
timestamp=self.timestamp,
387+
)
388+
389+
return ref_new
390+
370391
def encode(self):
371392
return json.dumps(self, cls=ReferenceEncoder)
372393

0 commit comments

Comments
 (0)