Skip to content

Commit

Permalink
Fixed guidance callback
Browse files Browse the repository at this point in the history
  • Loading branch information
Mokaz committed Apr 27, 2024
1 parent 6f749b5 commit 9886a10
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions motion/lqr_controller/lqr_controller/lqr_controller_node.py
Original file line number Diff line number Diff line change
Expand Up @@ -28,7 +28,7 @@ def __init__(self):
])

self.state_subscriber_ = self.create_subscription(Odometry, "/sensor/seapath/odom/ned", self.state_cb, qos_profile=qos_profile)
self.guidance_subscriber_ = self.create_subscription(Odometry, "controller/lqr/reference", self.guidance_cb, 1)
self.guidance_subscriber_ = self.create_subscription(Odometry, "guidance/dp/reference", self.guidance_cb, 1)
self.wrench_publisher_ = self.create_publisher(Wrench, "thrust/wrench_input", 1)

Q = self.get_parameter('lqr_controller.Q').get_parameter_value().double_array_value
Expand Down Expand Up @@ -56,7 +56,7 @@ def __init__(self):
def state_cb(self, msg):
self.state = odometrymsg_to_state(msg)

self.guidance_cb(self, msg):
def guidance_cb(self, msg):
self.x_ref = odometrymsg_to_state(msg)[:3]

def controller_callback(self):
Expand Down

0 comments on commit 9886a10

Please sign in to comment.