-
Notifications
You must be signed in to change notification settings - Fork 21
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
<feat> implemented Liner Quadratic Regulator #500
base: develop
Are you sure you want to change the base?
Conversation
control/velocity_controller_lqr/config/param_velocity_controller_lqr.yaml
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/launch/velocity_controller_lqr.launch.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Show resolved
Hide resolved
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Everything else was nice : )
control/velocity_controller_lqr/scripts/velocity_controller_lqr_node.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Show resolved
Hide resolved
8ee813a
to
9a171f1
Compare
control/velocity_controller_lqr/tests/test_velocity_controller_lqr.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/launch/velocity_controller_lqr.launch.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/scripts/velocity_controller_lqr_node.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/scripts/velocity_controller_lqr_node.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/scripts/velocity_controller_lqr_node.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/scripts/velocity_controller_lqr_node.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
control/velocity_controller_lqr/velocity_controller_lqr/velocity_controller_lqr_lib.py
Outdated
Show resolved
Hide resolved
ros__parameters: | ||
|
||
#topic parameters | ||
odom_topic: /nucleus/odom | ||
guidance_topic: /guidance/los | ||
thrust_topic: /thrust/wrench_input | ||
|
||
#LQR parameters | ||
|
||
q_surge: 75 | ||
q_pitch: 175 | ||
q_yaw: 175 | ||
|
||
r_surge: 0.3 | ||
r_pitch: 0.4 | ||
r_yaw: 0.4 | ||
|
||
i_surge: 0.3 | ||
i_pitch: 0.4 | ||
i_yaw: 0.3 | ||
|
||
i_weight: 0.5 | ||
|
||
inertia_matrix: [30.0, 0.6, 0.0, 0.6, 1.629, 0.0, 0.0, 0.0, 1.729] | ||
|
||
#Clamp parameter | ||
max_force: 99.5 |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Here you could do something like
ros__parameters:
topics:
odom_topic: ...
...
LQR_params:
q_surge: ...
...
|
||
# ---------------------------------------------------------------Main Function--------------------------------------------------------------- | ||
|
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
old?
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Almost there now
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
This file can be deleted
control/velocity_controller_lqr/scripts/velocity_controller_lqr_node.py
Outdated
Show resolved
Hide resolved
if self.controller.killswitch == False: | ||
if self.controller.operation_mode == "autonomous mode": | ||
self.publisherLQR.publish(msg) | ||
|
||
else: | ||
self.controller.reset_controller() | ||
else: | ||
self.controller.reset_controller() |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
not necessary to nest here
Fixed everything, AUV works flawlessly now.