调整传感器滤波值
This commit is contained in:
parent
26cf62214e
commit
638ecab791
@ -66,7 +66,7 @@ class ProgressActionClient(Node):
|
|||||||
# Parameters for optional position filtering
|
# Parameters for optional position filtering
|
||||||
self.declare_parameter('enable_filter', True)
|
self.declare_parameter('enable_filter', True)
|
||||||
self.declare_parameter('filter_type', 'ema')
|
self.declare_parameter('filter_type', 'ema')
|
||||||
self.declare_parameter('ema_alpha', 0.2)
|
self.declare_parameter('ema_alpha', 0.5)
|
||||||
self.declare_parameter('kalman_q', 1e-5)
|
self.declare_parameter('kalman_q', 1e-5)
|
||||||
self.declare_parameter('kalman_r', 1e-2)
|
self.declare_parameter('kalman_r', 1e-2)
|
||||||
|
|
||||||
|
|||||||
@ -63,7 +63,7 @@ class JointSensorNode(Node):
|
|||||||
js.position = angles
|
js.position = angles
|
||||||
self.publisher_.publish(js)
|
self.publisher_.publish(js)
|
||||||
|
|
||||||
self.get_logger().info(f"Published JointState: ids=0x{msg.arbitration_id:X} names={names} positions={angles}")
|
self.get_logger().debug(f"Published JointState: ids=0x{msg.arbitration_id:X} names={names} positions={angles}")
|
||||||
except Exception as e:
|
except Exception as e:
|
||||||
self.get_logger().error(f"Error handling CAN msg: {e}")
|
self.get_logger().error(f"Error handling CAN msg: {e}")
|
||||||
|
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user