diff --git a/ff_sim/ff_sim/controller_metrics.py b/ff_sim/ff_sim/controller_metrics.py index e725d3c..83a8550 100755 --- a/ff_sim/ff_sim/controller_metrics.py +++ b/ff_sim/ff_sim/controller_metrics.py @@ -88,10 +88,8 @@ def process_new_wheel_cmd(self, msg: WheelVelCommand) -> None: def process_new_binary_thrust_cmd(self, msg: ThrusterCommand) -> None: """Process binary thrusters""" - now = self.get_clock().now().to_msg() - dtsec = now.sec - self.curr_time.sec - dtnsec = now.nanosec - self.curr_time.nanosec - dt = dtsec + dtnsec / 1e9 + now = self.get_clock().now() + dt = (now - self.curr_time).nanoseconds / 1e9 # Perform Euler integration for how long each thruster was on thrusters = np.array(msg.switches, dtype=float)