Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Add support to track rigid body payloads #17

Open
wants to merge 24 commits into
base: qp-lee-payload
Choose a base branch
from

Conversation

whoenig
Copy link

@whoenig whoenig commented Dec 7, 2022

Compiles, but not tested. However, it includes some logging variables, so we can check both orientation and (filtered) omega without the need to fly.

@Khaledwahba1994 Khaledwahba1994 requested review from Khaledwahba1994 and removed request for Khaledwahba1994 December 13, 2022 22:22
@Khaledwahba1994
Copy link
Collaborator

Please review the latest commits

src/modules/src/controller_lee_payload.c Show resolved Hide resolved
Comment on lines 293 to 300
c_float Ax_new[45] = {
1, attPoint.z, -attPoint.y, n1.x, n2.x, 1, -attPoint.z, attPoint.x, n1.y, n2.y, 1, attPoint.y, attPoint.x, n1.z, n2.z,
1, attPoint2.z, -attPoint2.y, n3.x, n4.x, 1, -attPoint2.z, attPoint2.x, n3.y, n4.y, 1, attPoint2.y, attPoint2.x, n3.z, n4.z,
1, attPoint3.z, -attPoint3.y, n5.x, n6.x, 1, -attPoint3.z, attPoint3.x, n5.y, n6.y, 1, attPoint3.y, attPoint3.x, n5.z, n6.z,
};
c_int Ax_new_n = 45;
c_float l_new[12] = {F_d.x, F_d.y, F_d.z, M_d.x, M_d.y, M_d.z, -INFINITY, -INFINITY, -INFINITY, -INFINITY, -INFINITY, -INFINITY,};
c_float u_new[12] = {F_d.x, F_d.y, F_d.z, M_d.x, M_d.y, M_d.z, 0, 0, 0, 0, 0, 0};
Copy link
Author

Choose a reason for hiding this comment

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

This might require us to increase the task size even more: (45+12+12)*4 = 276 Bytes for these lines alone.

Copy link
Collaborator

Choose a reason for hiding this comment

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

I was just making sure that we can access all of the values and the changes are correct, but we can update this later to change it in a loop as discussed before.

src/modules/src/controller_lee_payload.c Outdated Show resolved Hide resolved
src/modules/src/controller_lee_payload.c Show resolved Hide resolved
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.

2 participants