Skip to content

Conversation

@myeatman-bdai
Copy link
Collaborator

Calculate higher order spline derivatives for the InterpSplineSE3 class.

Copy link
Contributor

@bokorn-bdaii bokorn-bdaii left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Looks good. Can you add the derivative computation to the unit tests and add a docstring to the derivative function.

linear_vel = self.spline_xyz.derivative()(t)
angular_vel = self.spline_so3(
t, 1
def derivative(self, t: float, order: int = 1) -> Twist3:
Copy link
Contributor

@bokorn-bdaii bokorn-bdaii Nov 20, 2025

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Add some warning that this only works for order = [1,2]. Current system throws a value error for order != [0,1,2] but will fail on order 0 with a "ValueError: bad value to Twist constructor" error. We should check and throw errors for order != [1,2].

Copy link
Collaborator Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Thanks for testing that

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

3 participants