17:53:44.875 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
17:53:44.875 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-06 17:53:44.875899920 +01:00
17:53:44.875 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
17:53:44.875 DEBUG [robot_code/utilities/logging/src/logging.rs:95] Logging initialized with handle: Handle { shared: ArcSwapAny(SharedLogger { root: ConfiguredLogger { level: Warn, appenders: [0, 1, 2, 3, 4], children: {"lobster_hardware_checks": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_camera": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_control": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sonar": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_payload": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_settings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_simulator": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_common": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_can": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_launch": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_logging": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_communication": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_live_stitching": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_state_estimation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sensors": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_actuation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_error_codes": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_usbl_driver": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_path_planning": ConfiguredLogger { level: Trace, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_task_scheduler": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_image_processing": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_python_bindings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_calibration": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_time": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }} }, appenders: [Appender { appender: ConsoleAppender { encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, do_write: true }, filters: [ThresholdFilter { level: Info }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Debug }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Error }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Warn }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 104857600 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
17:53:44.875 INFO  [robot_code/utilities/logging/src/logger_manager.rs:97] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_17-53-44_simulated_scout.lobsterlog")
17:53:44.881 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
17:53:44.882 INFO  [robot_code/robot_core/launch/src/lib.rs:130] Launching robot code with following settings:
Settings { actuation: ActuationSettings { max_current_change_per_second: 200.0, thruster_models: {"DD80_S3_tailcone": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-36.15, -31.34, -26.1, -22.34, -17.71, -13.05, -7.8, -4.95, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 4.95, 7.8, 13.05, 17.71, 22.34, 26.1, 31.34, 36.15] }, "DD50_S3_tailcone_RPM": ThrusterModel { currents: [-28400.0, -27680.0, -24670.0, -22010.0, -18470.0, -14700.0, -9920.0, -6450.0, -1000.0, 1000.0, 6450.0, 9920.0, 14700.0, 18470.0, 22010.0, 24670.0, 27680.0, 28400.0], thrusts: [-26.24, -25.3, -21.31, -16.54, -12.3, -7.3, -2.64, -0.78, -0.01, 0.01, 0.78, 2.64, 7.3, 12.3, 16.54, 21.31, 25.3, 26.24] }, "DD50_S3_tailcone": ThrusterModel { currents: [-25.0, -24.0, -22.0, -20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0, 22.0, 24.0, 25.0], thrusts: [-25.09, -23.83, -21.52, -19.0, -16.96, -15.1, -12.9, -11.11, -9.28, -7.05, -5.04, -2.79, -0.6, -0.01, 0.01, 0.78, 2.64, 4.89, 7.3, 9.9, 12.3, 14.44, 16.54, 18.76, 21.31, 23.6, 25.3, 26.24] }, "DD80_S3_tailcone_RPM": ThrusterModel { currents: [-19100.0, -16800.0, -15100.0, -13350.0, -11400.0, -9200.0, -6100.0, -3150.0, -1400.0, 1400.0, 3150.0, 6100.0, 9200.0, 11400.0, 13350.0, 15100.0, 16800.0, 19100.0], thrusts: [-65.6, -46.9, -36.15, -26.1, -17.71, -7.8, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 7.8, 17.71, 26.1, 36.15, 46.9, 65.6] }, "T500_S3_tailcone_basic_SLS_prop": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-42.03, -37.82, -33.02, -28.7, -24.7, -19.93, -16.03, -12.8, -8.0, -4.26, -0.001, 0.001, 3.06, 9.01, 14.23, 17.89, 22.8, 27.0, 32.66, 37.82, 42.8, 46.5] }}, thrusters: [ThrusterSettings { current_reversed: false, index: 7, model: "T500_S3_tailcone_basic_SLS_prop", name: "main_forwards", position: None, thruster_direction: [1.0, 0.0, 0.0], rpm_controlled: false }, ThrusterSettings { current_reversed: false, index: 6, model: "DD80_S3_tailcone_RPM", name: "rear_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 4, model: "DD50_S3_tailcone_RPM", name: "rear_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 5, model: "DD50_S3_tailcone_RPM", name: "rear_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 1, model: "DD80_S3_tailcone_RPM", name: "front_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 2, model: "DD50_S3_tailcone_RPM", name: "front_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 3, model: "DD50_S3_tailcone_RPM", name: "front_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }] }, camera: CameraSettings { exposure_control_settings_list: [ExposureControl { exposure_target: 0.3, exposure_target_quantile: 0.3, gain_margin: 3.0, gain_target: 5.0, name: "default" }, ExposureControl { exposure_target: 0.4, exposure_target_quantile: 0.95, gain_margin: 3.0, gain_target: 5.0, name: "highlights" }], stereo: false, lights: Some(Lights { temperature_sensors: {"nosecone": [218469099307008, 214543499198464], "tailcone": [144801820246016, 164593029545984]}, overheating_threshold: 50.0 }), use_mocked: true, use_hardware_triggers: true, vertical_fov_degrees: 51.4, live_stitching: None }, communication: CommunicationSettings { discovery_node: DiscoveryNodeSettings { broadcast_ips: [255.255.255.255, 192.168.30.255], broadcast_interfaces: [], broadcast_port: 10899 }, identity: IdentitySettings { name: "simulated_scout", serial_number: None, ip_addresses: [], usbl_id: 3 }, enabled: true, request_server: RequestServer { port: 10820 }, ui_settings_whitelist: ["actuation/max_current_change_per_second", "camera/use_mocked", "communication/world_model_update_frequency_hz", "control/frequency", "active_profile", "path_planner", "robot", "safety/min_cell_voltage", "safety/max_battery_temperature", "safety/min_altitude", "safety/max_altitude", "safety/altitude_safety_fallback_buffer", "safety/altitude_setpoint_buffer", "safety/max_expected_sea_floor_depth", "safety/min_expected_sea_floor_depth", "safety/max_update_dt", "safety/max_thruster_temp", "safety/max_thruster_disconnect_time", "safety/min_dvl_altitude_working", "safety/min_dvl_depth_working", "safety/max_roll_error_degrees", "safety/roll_safety_fallback_buffer_degrees", "safety/roll_safety_fallback_max_duration_seconds", "safety/max_pitch_error_degrees", "safety/max_position_error_meters", "sensors/imu/frequency", "sensors/nortek_dvl/start_measuring_pressure_only", "sensors/nortek_dvl/dvl_settings/led", "sensors/nortek_dvl/dvl_settings/record_199_data", "sensors/nortek_dvl/dvl_settings/measuring_mode", "sensors/nortek_dvl/dvl_settings/sample_rate", "sensors/nortek_dvl/dvl_settings/cp_sample_interval", "sensors/nortek_dvl/dvl_settings/salinity", "sensors/nortek_dvl/dvl_settings/bt_range", "sensors/nortek_dvl/dvl_settings/bt_max_along_beam_velocity", "state_estimation", "task_scheduler"], world_model_update_frequency_hz: 20.0 }, control: ControlSettings { frequency: 100.0, model: ControlModel { d_linear: [[2.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 40.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 40.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 1.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]], d_quadratic: [[55.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 400.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 400.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 4.882, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 80.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 80.0]], damping_x_asym: 0.0, m_a: [[2.27703, 0.0, 0.0, 0.0, -0.00977, -0.0], [0.0, 66.39192, 0.0, 0.07973, 0.0, -0.38227], [0.0, 0.0, 65.93975, 0.0, 0.4623, -0.0], [0.0, 0.07973, 0.0, 0.72, 0.0, 0.01411], [-0.00977, 0.0, 0.4623, 0.0, 19.17022, -0.0], [-0.0, -0.38227, -0.0, 0.01411, -0.0, 19.18307]], modules: Modules { module_configuration: ["scout_3"], modules: {"scout_3": ModuleInformation { center_of_mass: [1.00235121, 0.00123998, 0.00154298], center_of_volume: [0.99326563, -1.34e-6, -0.0], length: 1.91214, mass: 52.44353958, moment_of_inertia: [[0.26065892, 0.00607949, -0.00522948], [0.00607949, 12.7208684, 0.00011234], [-0.00522948, 0.00011234, 12.69270147]], name: "scout_3", poi: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_front_location": [1.1187, 0.0, 0.0066], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "gps_2_location": [1.05957, -0.00255, -0.20834], "camera_rear_location": [0.9707, 0.0, 0.0066], "imu_location": [1.22915, -0.07144, -0.03025], "ps_location": [1.28577, 0.0, 0.06725], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717]}), volume: 0.053 }}, standard_hull_radius: 0.1, volume_error: 0.0 }, pos_co_b: [0.0, 0.0, 0.0], water_density: 997.0 }, pids: Pids { x_angular_velocity: PidParameters { kp: 14.0, ki: 1.0, kd: 0.3, min: -2.0, max: 2.0, cut_off_freq: 10.0 }, x_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.04, min: -1.0, max: 1.0, cut_off_freq: 10.0 }, x_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, x_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 5.0, min: -42.03, max: 46.5, cut_off_freq: 10.0 }, y_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, y_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, y_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, y_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 15.0, min: -50.0, max: 50.0, cut_off_freq: 10.0 }, z_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, z_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, z_position: PidParameters { kp: 1.5, ki: 0.0, kd: 0.075, min: -0.25, max: 0.25, cut_off_freq: 10.0 }, z_velocity: PidParameters { kp: 200.0, ki: 15.0, kd: 10.0, min: -40.0, max: 40.0, cut_off_freq: 10.0 } }, forward_roll_cross_coupling_gain: -0.02 }, path_planner: PathPlannerSettings { control_attitude_tolerance_degrees: 6.0, control_goal_timeout_seconds: 15, control_position_tolerance_meters: 0.1, control_request_timeout_millis: 100, desired_update_frequency: 40.0, fallback_survey_orientation_degrees: 0.0, max_time_to_wait_for_new_goal_seconds: 0.5, polygon_scaling_factor: 1.02, vertical_position_constraints: VerticalPositionConstraints { min_preferred_altitude: 3.0, min_preferred_depth: 5.0, min_required_altitude: 1.0, min_required_depth: 0.0, velocity_at_min_required_altitude: 0.5, velocity_at_min_required_depth: 0.9, velocity_in_preferred_range: 1.0, velocity_limit_depth: 10.0 }, strategy_planner_parameters: StrategyPlannerParameters { heading_deviation_threshold_degrees: 6.0, position_threshold_xy: 0.7, setpoint_radius_xy: 0.6, line_end_threshold: 0.1, low_velocity_threshold: 0.1, max_line_deviation_xy: 0.15, max_pitch_slope_degrees: 30.0, static_surface_depth: 0.1, motion_planner_parameters: MotionPlannerParameters { max_acceleration: [0.5, 0.1, 0.3], max_angular_acceleration: [0.5, 0.5, 0.5], max_angular_velocity: [0.5, 0.3, 0.3], max_deceleration: [0.4, 0.3, 0.3], max_velocity: [1.2, 0.2, 0.2] }, orientation_distance_threshold: 0.2, position_on_track_hysteresis: 0.1, timeout_delay_seconds: 60.0, timeout_delay_factor: 2.5, estimate_delay_seconds: 30.0, estimate_delay_factor: 1.5, position_threshold_z: 0.1 } }, robot: RobotSettings { logging_name: "simulated_scout", can_enabled: false, enable_thrusters: true }, safety: SafetySettings { altitude_safety_fallback_buffer: 0.1, altitude_setpoint_buffer: 0.1, max_altitude: 50.0, max_battery_temperature: 40.0, max_depth: 40.2, max_expected_sea_floor_depth: 45.0, max_pitch_error_degrees: 45.0, max_position_error_meters: 20.0, max_roll_error_degrees: 45.0, max_thruster_disconnect_time: 5.0, max_thruster_temp: 70.0, max_update_dt: 0.5, min_altitude: 0.3, min_cell_voltage: 3.4, min_dvl_altitude_working: 20.0, min_dvl_depth_working: 5.0, min_expected_sea_floor_depth: 0.0, roll_safety_fallback_buffer_degrees: 15.0, roll_safety_fallback_max_duration_seconds: 5.0 }, sensors: SensorSettings { gps: Gps { enabled: false }, imu: Imu { acc_a: [0.998631, 0.0, 0.0, 0.0, 0.998631, 0.0, 0.0, 0.0, 0.998631], acc_b: [0.0, 0.0, 0.0], enabled: false, filter_low_pass_3_db_frequency: 20.0, frequency: 250.0, gyro_b: [-0.000357, 0.000623, 0.001831], name: Adis164753, orientation: [0.0, 1.0, 0.0, 0.0, 0.0, 1.0, 1.0, 0.0, 0.0] }, magnetometer: Magnetometer { enabled: false, mag_a: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0], mag_b: [0.0, 1.0, 0.0], orientation: [1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, -1.0, 0.0] }, nortek_dvl: NortekDvl { command_port_timeout_millis: 2000, data_port_timeout_millis: 500, dvl_settings: DvlSettings { bt_blanking_distance: 0.06, bt_max_along_beam_velocity: 5.0, bt_range: 50.0, bt_settings_raw: "NB=4,CH=0,DF=21,PL=0.0,WTDF=22,PLMODE=\"MAX\"", cp_blanking_distance: 1.0, cp_cell_size: 1.0, cp_number_of_cells: 30, cp_sample_interval: 10, cp_settings_raw: "CY=\"XYZ\",PL=0.0,VP=0.000,VR=2.50,DF=3,NB=4,CH=0", do_fast_pressure: true, do_water_track: false, dvl_settings_raw: "TRIG=\"INTSR\",FN=\"\",SV=0,ALTI=0,FASTTRIG=1", fast_pressure_sample_rate: 30, fast_pressure_settings_raw: "DF=41", initial_pressure_offset: 9.51, instrument_yaw: 0.0, led: false, measuring_mode: Auto, record_199_data: false, salinity: 35.0, sample_rate: 8.0 }, enabled: false, host: "192.168.30.102", id: 106006, start_measuring_pressure_only: false }, sonar: Sonar { enabled: false, tilt_degree: 15.0 }, usbl: None }, active_profile: Default, simulator: Some(SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }), state_estimation: StateEstimationSettings { depth_samples_max_timeout_millis: 10000, external_disturbance_heading_valid_time_minutes: 60.0, gnss_samples_use_one_in_n: 8, seafloor_depth_smoothing_factor: 0.7, magnetic_field_strength_deviation: 4.0 }, task_scheduler: TaskSchedulerSettings { preparing_behavior: PreparationModeBehavior { max_number_gps_tasks: 2, max_number_move_to_start_tasks: 2 }, desired_update_frequency: 50.0, excessive_current_handling: ExcessiveCurrentParams { lateral_disturbance_threshold: 0.9, lateral_velocity_threshold: 0.07, time_threshold: 10.0, trigger_check_period_seconds: 0.1, trigger_count_limit_per_survey: 5, max_time_to_disable_preparation_tasks_minutes: 10.0 }, task_settings: TaskSettings { max_horizontal_distance_to_start_meters: 300.0, buoyancy_calibration: BuoyancyCalibrationSettings { calibration_depth: 1.0, minimum_required_seafloor_depth: 2.0, pitch_step_degrees: 20.0, roll_step_degrees: 20.0, step_duration_seconds: 20.0, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, external_disturbance_estimation: ExternalDisturbanceEstimationSettings { acceptable_normalized_lateral_disturbance: 0.4, lateral_disturbance_optimization_threshold: 0.05, longitudinal_disturbance_direction_threshold: 0.1, min_binary_search_step_size_degrees: 3.0, minimum_task_depth_meters: 1.0, wait_between_steps_seconds: 30.0 }, get_gps: GetGpsSettings { max_duration_seconds: 300.0, step_duration_seconds: 2.0, minimum_uncertainty_meters: 1.0, ascend_position_control_disable_depth: 1.5 }, hold: HoldSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, magnetometer_calibration: MagnetometerCalibrationSettings { calibration_depth: 1.5, minimum_required_seafloor_depth: 3.0, pitch_steps: 5, roll_steps: 4, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, manual_control: ManualControlSettings { default_force: 20.0, max_angular_velocity: 0.2, max_depth: 1.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.05, initial_pitch_setpoint_deg: 5.0, control_yaw_error: false }, move_to: MoveToSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, survey_area: SurveySettings { max_horizontal_distance_to_start_meters: None, default_velocity_meter_per_second: 0.4, maximum_velocity_meter_per_second: 1.5, min_current_magnitude_meter_per_second: 0.1, polygon_safety_scaling_factor: 1.02, max_initial_position_uncertainty_meters: 3.0 }, visibility_check: VisibilityCheckSettings { default_start_altitude: 3.0, default_end_altitude: 0.5, diving_velocity: 0.2, photo_interval: 0.1 } }, waiting_hold_duration_seconds: 300.0 } }
17:53:44.952 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_front_location": [1.1187, 0.0, 0.0066], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "gps_2_location": [1.05957, -0.00255, -0.20834], "camera_rear_location": [0.9707, 0.0, 0.0066], "imu_location": [1.22915, -0.07144, -0.03025], "ps_location": [1.28577, 0.0, 0.06725], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717]})
17:53:44.952 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:53:44.953 INFO  [robot_code/utilities/simulator/src/simulator.rs:89] Initializing simulator with timestep: 20ms and simulator settings: SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }
17:53:45.129 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_front_location": [1.1187, 0.0, 0.0066], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "gps_2_location": [1.05957, -0.00255, -0.20834], "camera_rear_location": [0.9707, 0.0, 0.0066], "imu_location": [1.22915, -0.07144, -0.03025], "ps_location": [1.28577, 0.0, 0.06725], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717]})
17:53:45.129 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:53:45.530 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_front_location": [1.1187, 0.0, 0.0066], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "gps_2_location": [1.05957, -0.00255, -0.20834], "camera_rear_location": [0.9707, 0.0, 0.0066], "imu_location": [1.22915, -0.07144, -0.03025], "ps_location": [1.28577, 0.0, 0.06725], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717]})
17:53:45.530 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:53:45.530 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
17:53:45.531 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
17:53:45.531 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
17:53:45.531 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
17:53:45.531 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
17:53:45.531 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
17:53:45.531 WARN  [robot_code/robot_core/launch/src/lib.rs:570] IMU not enabled
17:53:45.531 WARN  [robot_code/robot_core/launch/src/lib.rs:588] Magnetometer not enabled
17:53:45.531 WARN  [robot_code/robot_core/launch/src/lib.rs:176] Magnetometer not enabled, state estimation will not be able to use it
17:53:45.531 WARN  [robot_code/robot_core/launch/src/lib.rs:627] Nortek DVL not enabled
17:53:45.531 WARN  [robot_code/robot_core/launch/src/lib.rs:606] GPS not enabled
17:53:45.531 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
17:53:45.532 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
17:53:45.532 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
17:53:45.533 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
17:53:45.534 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
17:53:45.534 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_front_location": [1.1187, 0.0, 0.0066], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "gps_2_location": [1.05957, -0.00255, -0.20834], "camera_rear_location": [0.9707, 0.0, 0.0066], "imu_location": [1.22915, -0.07144, -0.03025], "ps_location": [1.28577, 0.0, 0.06725], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717]})
17:53:45.534 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:53:45.535 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
17:53:45.535 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'control' with StopRunningFlag { name: "control", id: 0, stop_running: false, do_auto_stop: true }
17:53:45.535 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
17:53:45.535 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
17:53:45.535 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 16622
17:53:45.535 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
17:53:45.535 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
17:53:45.535 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
17:53:45.536 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
17:53:45.545 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
17:53:45.545 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'simulator' with StopRunningFlag { name: "simulator", id: 0, stop_running: false, do_auto_stop: true }
17:53:45.545 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
17:53:45.545 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 16626
17:53:45.575 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
17:53:45.614 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
17:53:45.614 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
17:53:45.614 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'path_planner' with StopRunningFlag { name: "path_planner", id: 0, stop_running: false, do_auto_stop: true }
17:53:45.614 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
17:53:45.614 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
17:53:45.614 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
17:53:45.614 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 16628
17:53:45.634 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
17:53:45.635 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
17:53:45.635 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'task_scheduler' with StopRunningFlag { name: "task_scheduler", id: 0, stop_running: false, do_auto_stop: true }
17:53:45.635 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
17:53:45.635 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 16635
17:53:45.635 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
17:53:45.635 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
17:53:45.636 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for lora_module
17:53:45.636 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'lora_module' with StopRunningFlag { name: "lora_module", id: 0, stop_running: false, do_auto_stop: true }
17:53:45.636 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'lora_module' successfully started
17:53:45.636 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread lora_module with pid: 16686
17:53:45.636 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for outgoing_message
17:53:45.674 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
17:53:45.674 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
17:53:45.674 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:53:45.677 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"sensors": Object {"magnetometer": Object {"magA": Array [Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0)], "magB": Array [Number(0.0), Number(1.0), Number(0.0)]}}}
17:53:45.677 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'device_settings'. Description: Dynamic device specific settings. During runtime, these settings can be changed either by the user or by the robot itself.
17:53:45.678 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
17:53:45.678 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
17:53:45.680 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"camera": Object {"live_stitching": Null, "use_mocked": Bool(true)}, "communication": Object {"enabled": Bool(false), "identity": Object {"name": String("simulated_scout")}}, "robot": Object {"can_enabled": Bool(false), "logging_name": String("simulated_scout")}, "sensors": Object {"gps": Object {"enabled": Bool(false)}, "imu": Object {"enabled": Bool(false)}, "magnetometer": Object {"enabled": Bool(false)}, "nortek_dvl": Object {"enabled": Bool(false)}, "sonar": Object {"enabled": Bool(false), "tilt_degree": Number(15.0)}, "usbl": Null}, "simulator": Object {"bottom": String("flat"), "enable_user_debug_parameters": Bool(false), "gui": Bool(false), "multi_beam": Object {"fov": Number(120), "n_beams": Number(50), "pos": Array [Number(0.9), Number(0.0), Number(0.0)], "range": Number(15.0), "tilt": Number(20.0), "visualize_beams": Bool(true)}, "origin_latitude": Number(52.048187), "origin_longitude": Number(4.369903), "realtime": Bool(false), "scout_model": String("scout3"), "sea_floor_depth": Number(10.0), "sensor_noises": Object {"noise_scaling_factor": Number(1.0), "std_accelerometer": Number(0.02), "std_depth": Number(0.02), "std_dvl_beam_distance": Number(0.1), "std_dvl_velocity": Number(0.01), "std_gnss_receiver": Number(0.5), "std_gyroscope": Number(0.002), "std_magnetometer": Number(2.0)}, "start_attitude_euler_degrees": Array [Number(0.0), Number(0.0), Number(0.0)], "start_position": Array [Number(0), Number(0), Number(1)], "steps_per_second": Number(50), "water_current": Array [Number(0.0), Number(0.0), Number(0.0)]}}
17:53:45.680 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
17:53:45.682 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
17:53:45.682 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'communication' with StopRunningFlag { name: "communication", id: 0, stop_running: false, do_auto_stop: true }
17:53:45.682 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
17:53:45.682 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 16688
17:53:45.682 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
17:53:45.682 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
17:53:45.682 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:81] grpc listening on 0.0.0.0:10820
17:53:45.682 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
17:53:45.682 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
17:53:45.682 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Waiting until code stops running so threads can be joined
17:53:45.682 INFO  [robot_code/robot_core/launch/src/lib.rs:553] Trying to join thread 'control'
17:53:45.694 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:53:45.695 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:108] StopRunningFlag { name: "request_handling_toolbox", id: 0, stop_running: false, do_auto_stop: false } got dropped, but auto stop is disabled.
17:53:45.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'discovery_node' with StopRunningFlag { name: "discovery_node", id: 0, stop_running: false, do_auto_stop: false }
17:53:45.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
17:53:45.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 16691
17:53:45.697 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:155] Started watching interfaces
17:53:45.697 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:100] Sending heartbeat simulated_scout:318451712@[] to: ["192.168.30.255:10899", "255.255.255.255:10899"]
17:53:45.698 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for core_telemetry_stream
17:53:45.698 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for periodic_telemetry_stream
17:53:46.577 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.42Hz
17:57:24.639 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
17:57:24.639 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-06 17:57:24.639921093 +01:00
17:57:24.639 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
17:57:24.639 DEBUG [robot_code/utilities/logging/src/logging.rs:95] Logging initialized with handle: Handle { shared: ArcSwapAny(SharedLogger { root: ConfiguredLogger { level: Warn, appenders: [0, 1, 2, 3, 4], children: {"lobster_hardware_checks": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_camera": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_control": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sonar": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_payload": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_settings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_simulator": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_common": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_can": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_launch": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_logging": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_communication": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_live_stitching": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_state_estimation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sensors": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_actuation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_error_codes": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_usbl_driver": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_path_planning": ConfiguredLogger { level: Trace, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_task_scheduler": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_image_processing": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_python_bindings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_calibration": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_time": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }} }, appenders: [Appender { appender: ConsoleAppender { encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, do_write: true }, filters: [ThresholdFilter { level: Info }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Debug }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Error }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Warn }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 104857600 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
17:57:24.639 INFO  [robot_code/utilities/logging/src/logger_manager.rs:97] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_17-57-24_simulated_scout.lobsterlog")
17:57:24.642 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
17:57:24.643 INFO  [robot_code/robot_core/launch/src/lib.rs:130] Launching robot code with following settings:
Settings { actuation: ActuationSettings { max_current_change_per_second: 200.0, thruster_models: {"DD50_S3_tailcone_RPM": ThrusterModel { currents: [-28400.0, -27680.0, -24670.0, -22010.0, -18470.0, -14700.0, -9920.0, -6450.0, -1000.0, 1000.0, 6450.0, 9920.0, 14700.0, 18470.0, 22010.0, 24670.0, 27680.0, 28400.0], thrusts: [-26.24, -25.3, -21.31, -16.54, -12.3, -7.3, -2.64, -0.78, -0.01, 0.01, 0.78, 2.64, 7.3, 12.3, 16.54, 21.31, 25.3, 26.24] }, "DD50_S3_tailcone": ThrusterModel { currents: [-25.0, -24.0, -22.0, -20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0, 22.0, 24.0, 25.0], thrusts: [-25.09, -23.83, -21.52, -19.0, -16.96, -15.1, -12.9, -11.11, -9.28, -7.05, -5.04, -2.79, -0.6, -0.01, 0.01, 0.78, 2.64, 4.89, 7.3, 9.9, 12.3, 14.44, 16.54, 18.76, 21.31, 23.6, 25.3, 26.24] }, "DD80_S3_tailcone": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-36.15, -31.34, -26.1, -22.34, -17.71, -13.05, -7.8, -4.95, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 4.95, 7.8, 13.05, 17.71, 22.34, 26.1, 31.34, 36.15] }, "DD80_S3_tailcone_RPM": ThrusterModel { currents: [-19100.0, -16800.0, -15100.0, -13350.0, -11400.0, -9200.0, -6100.0, -3150.0, -1400.0, 1400.0, 3150.0, 6100.0, 9200.0, 11400.0, 13350.0, 15100.0, 16800.0, 19100.0], thrusts: [-65.6, -46.9, -36.15, -26.1, -17.71, -7.8, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 7.8, 17.71, 26.1, 36.15, 46.9, 65.6] }, "T500_S3_tailcone_basic_SLS_prop": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-42.03, -37.82, -33.02, -28.7, -24.7, -19.93, -16.03, -12.8, -8.0, -4.26, -0.001, 0.001, 3.06, 9.01, 14.23, 17.89, 22.8, 27.0, 32.66, 37.82, 42.8, 46.5] }}, thrusters: [ThrusterSettings { current_reversed: false, index: 7, model: "T500_S3_tailcone_basic_SLS_prop", name: "main_forwards", position: None, thruster_direction: [1.0, 0.0, 0.0], rpm_controlled: false }, ThrusterSettings { current_reversed: false, index: 6, model: "DD80_S3_tailcone_RPM", name: "rear_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 4, model: "DD50_S3_tailcone_RPM", name: "rear_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 5, model: "DD50_S3_tailcone_RPM", name: "rear_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 1, model: "DD80_S3_tailcone_RPM", name: "front_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 2, model: "DD50_S3_tailcone_RPM", name: "front_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 3, model: "DD50_S3_tailcone_RPM", name: "front_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }] }, camera: CameraSettings { exposure_control_settings_list: [ExposureControl { exposure_target: 0.3, exposure_target_quantile: 0.3, gain_margin: 3.0, gain_target: 5.0, name: "default" }, ExposureControl { exposure_target: 0.4, exposure_target_quantile: 0.95, gain_margin: 3.0, gain_target: 5.0, name: "highlights" }], stereo: false, lights: Some(Lights { temperature_sensors: {"nosecone": [218469099307008, 214543499198464], "tailcone": [144801820246016, 164593029545984]}, overheating_threshold: 50.0 }), use_mocked: true, use_hardware_triggers: true, vertical_fov_degrees: 51.4, live_stitching: None }, communication: CommunicationSettings { discovery_node: DiscoveryNodeSettings { broadcast_ips: [255.255.255.255, 192.168.30.255], broadcast_interfaces: [], broadcast_port: 10899 }, identity: IdentitySettings { name: "simulated_scout", serial_number: None, ip_addresses: [], usbl_id: 3 }, enabled: true, request_server: RequestServer { port: 10820 }, ui_settings_whitelist: ["actuation/max_current_change_per_second", "camera/use_mocked", "communication/world_model_update_frequency_hz", "control/frequency", "active_profile", "path_planner", "robot", "safety/min_cell_voltage", "safety/max_battery_temperature", "safety/min_altitude", "safety/max_altitude", "safety/altitude_safety_fallback_buffer", "safety/altitude_setpoint_buffer", "safety/max_expected_sea_floor_depth", "safety/min_expected_sea_floor_depth", "safety/max_update_dt", "safety/max_thruster_temp", "safety/max_thruster_disconnect_time", "safety/min_dvl_altitude_working", "safety/min_dvl_depth_working", "safety/max_roll_error_degrees", "safety/roll_safety_fallback_buffer_degrees", "safety/roll_safety_fallback_max_duration_seconds", "safety/max_pitch_error_degrees", "safety/max_position_error_meters", "sensors/imu/frequency", "sensors/nortek_dvl/start_measuring_pressure_only", "sensors/nortek_dvl/dvl_settings/led", "sensors/nortek_dvl/dvl_settings/record_199_data", "sensors/nortek_dvl/dvl_settings/measuring_mode", "sensors/nortek_dvl/dvl_settings/sample_rate", "sensors/nortek_dvl/dvl_settings/cp_sample_interval", "sensors/nortek_dvl/dvl_settings/salinity", "sensors/nortek_dvl/dvl_settings/bt_range", "sensors/nortek_dvl/dvl_settings/bt_max_along_beam_velocity", "state_estimation", "task_scheduler"], world_model_update_frequency_hz: 20.0 }, control: ControlSettings { frequency: 100.0, model: ControlModel { d_linear: [[2.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 40.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 40.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 1.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]], d_quadratic: [[55.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 400.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 400.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 4.882, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 80.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 80.0]], damping_x_asym: 0.0, m_a: [[2.27703, 0.0, 0.0, 0.0, -0.00977, -0.0], [0.0, 66.39192, 0.0, 0.07973, 0.0, -0.38227], [0.0, 0.0, 65.93975, 0.0, 0.4623, -0.0], [0.0, 0.07973, 0.0, 0.72, 0.0, 0.01411], [-0.00977, 0.0, 0.4623, 0.0, 19.17022, -0.0], [-0.0, -0.38227, -0.0, 0.01411, -0.0, 19.18307]], modules: Modules { module_configuration: ["scout_3"], modules: {"scout_3": ModuleInformation { center_of_mass: [1.00235121, 0.00123998, 0.00154298], center_of_volume: [0.99326563, -1.34e-6, -0.0], length: 1.91214, mass: 52.44353958, moment_of_inertia: [[0.26065892, 0.00607949, -0.00522948], [0.00607949, 12.7208684, 0.00011234], [-0.00522948, 0.00011234, 12.69270147]], name: "scout_3", poi: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "usbl_modem_location": [1.3235, 0.0, -0.09595], "camera_front_location": [1.1187, 0.0, 0.0066]}), volume: 0.053 }}, standard_hull_radius: 0.1, volume_error: 0.0 }, pos_co_b: [0.0, 0.0, 0.0], water_density: 997.0 }, pids: Pids { x_angular_velocity: PidParameters { kp: 14.0, ki: 1.0, kd: 0.3, min: -2.0, max: 2.0, cut_off_freq: 10.0 }, x_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.04, min: -1.0, max: 1.0, cut_off_freq: 10.0 }, x_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, x_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 5.0, min: -42.03, max: 46.5, cut_off_freq: 10.0 }, y_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, y_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, y_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, y_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 15.0, min: -50.0, max: 50.0, cut_off_freq: 10.0 }, z_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, z_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, z_position: PidParameters { kp: 1.5, ki: 0.0, kd: 0.075, min: -0.25, max: 0.25, cut_off_freq: 10.0 }, z_velocity: PidParameters { kp: 200.0, ki: 15.0, kd: 10.0, min: -40.0, max: 40.0, cut_off_freq: 10.0 } }, forward_roll_cross_coupling_gain: -0.02 }, path_planner: PathPlannerSettings { control_attitude_tolerance_degrees: 6.0, control_goal_timeout_seconds: 15, control_position_tolerance_meters: 0.1, control_request_timeout_millis: 100, desired_update_frequency: 40.0, fallback_survey_orientation_degrees: 0.0, max_time_to_wait_for_new_goal_seconds: 0.5, polygon_scaling_factor: 1.02, vertical_position_constraints: VerticalPositionConstraints { min_preferred_altitude: 3.0, min_preferred_depth: 5.0, min_required_altitude: 1.0, min_required_depth: 0.0, velocity_at_min_required_altitude: 0.5, velocity_at_min_required_depth: 0.9, velocity_in_preferred_range: 1.0, velocity_limit_depth: 10.0 }, strategy_planner_parameters: StrategyPlannerParameters { heading_deviation_threshold_degrees: 6.0, position_threshold_xy: 0.7, setpoint_radius_xy: 0.6, line_end_threshold: 0.1, low_velocity_threshold: 0.1, max_line_deviation_xy: 0.15, max_pitch_slope_degrees: 30.0, static_surface_depth: 0.1, motion_planner_parameters: MotionPlannerParameters { max_acceleration: [0.5, 0.1, 0.3], max_angular_acceleration: [0.5, 0.5, 0.5], max_angular_velocity: [0.5, 0.3, 0.3], max_deceleration: [0.4, 0.3, 0.3], max_velocity: [1.2, 0.2, 0.2] }, orientation_distance_threshold: 0.2, position_on_track_hysteresis: 0.1, timeout_delay_seconds: 60.0, timeout_delay_factor: 2.5, estimate_delay_seconds: 30.0, estimate_delay_factor: 1.5, position_threshold_z: 0.1 } }, robot: RobotSettings { logging_name: "simulated_scout", can_enabled: false, enable_thrusters: true }, safety: SafetySettings { altitude_safety_fallback_buffer: 0.1, altitude_setpoint_buffer: 0.1, max_altitude: 50.0, max_battery_temperature: 40.0, max_depth: 40.2, max_expected_sea_floor_depth: 45.0, max_pitch_error_degrees: 45.0, max_position_error_meters: 20.0, max_roll_error_degrees: 45.0, max_thruster_disconnect_time: 5.0, max_thruster_temp: 70.0, max_update_dt: 0.5, min_altitude: 0.3, min_cell_voltage: 3.4, min_dvl_altitude_working: 20.0, min_dvl_depth_working: 5.0, min_expected_sea_floor_depth: 0.0, roll_safety_fallback_buffer_degrees: 15.0, roll_safety_fallback_max_duration_seconds: 5.0 }, sensors: SensorSettings { gps: Gps { enabled: false }, imu: Imu { acc_a: [0.998631, 0.0, 0.0, 0.0, 0.998631, 0.0, 0.0, 0.0, 0.998631], acc_b: [0.0, 0.0, 0.0], enabled: false, filter_low_pass_3_db_frequency: 20.0, frequency: 250.0, gyro_b: [-0.000357, 0.000623, 0.001831], name: Adis164753, orientation: [0.0, 1.0, 0.0, 0.0, 0.0, 1.0, 1.0, 0.0, 0.0] }, magnetometer: Magnetometer { enabled: false, mag_a: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0], mag_b: [0.0, 1.0, 0.0], orientation: [1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, -1.0, 0.0] }, nortek_dvl: NortekDvl { command_port_timeout_millis: 2000, data_port_timeout_millis: 500, dvl_settings: DvlSettings { bt_blanking_distance: 0.06, bt_max_along_beam_velocity: 5.0, bt_range: 50.0, bt_settings_raw: "NB=4,CH=0,DF=21,PL=0.0,WTDF=22,PLMODE=\"MAX\"", cp_blanking_distance: 1.0, cp_cell_size: 1.0, cp_number_of_cells: 30, cp_sample_interval: 10, cp_settings_raw: "CY=\"XYZ\",PL=0.0,VP=0.000,VR=2.50,DF=3,NB=4,CH=0", do_fast_pressure: true, do_water_track: false, dvl_settings_raw: "TRIG=\"INTSR\",FN=\"\",SV=0,ALTI=0,FASTTRIG=1", fast_pressure_sample_rate: 30, fast_pressure_settings_raw: "DF=41", initial_pressure_offset: 9.51, instrument_yaw: 0.0, led: false, measuring_mode: Auto, record_199_data: false, salinity: 35.0, sample_rate: 8.0 }, enabled: false, host: "192.168.30.102", id: 106006, start_measuring_pressure_only: false }, sonar: Sonar { enabled: false, tilt_degree: 15.0 }, usbl: None }, active_profile: Default, simulator: Some(SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }), state_estimation: StateEstimationSettings { depth_samples_max_timeout_millis: 10000, external_disturbance_heading_valid_time_minutes: 60.0, gnss_samples_use_one_in_n: 8, seafloor_depth_smoothing_factor: 0.7, magnetic_field_strength_deviation: 4.0 }, task_scheduler: TaskSchedulerSettings { preparing_behavior: PreparationModeBehavior { max_number_gps_tasks: 2, max_number_move_to_start_tasks: 2 }, desired_update_frequency: 50.0, excessive_current_handling: ExcessiveCurrentParams { lateral_disturbance_threshold: 0.9, lateral_velocity_threshold: 0.07, time_threshold: 10.0, trigger_check_period_seconds: 0.1, trigger_count_limit_per_survey: 5, max_time_to_disable_preparation_tasks_minutes: 10.0 }, task_settings: TaskSettings { max_horizontal_distance_to_start_meters: 300.0, buoyancy_calibration: BuoyancyCalibrationSettings { calibration_depth: 1.0, minimum_required_seafloor_depth: 2.0, pitch_step_degrees: 20.0, roll_step_degrees: 20.0, step_duration_seconds: 20.0, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, external_disturbance_estimation: ExternalDisturbanceEstimationSettings { acceptable_normalized_lateral_disturbance: 0.4, lateral_disturbance_optimization_threshold: 0.05, longitudinal_disturbance_direction_threshold: 0.1, min_binary_search_step_size_degrees: 3.0, minimum_task_depth_meters: 1.0, wait_between_steps_seconds: 30.0 }, get_gps: GetGpsSettings { max_duration_seconds: 300.0, step_duration_seconds: 2.0, minimum_uncertainty_meters: 1.0, ascend_position_control_disable_depth: 1.5 }, hold: HoldSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, magnetometer_calibration: MagnetometerCalibrationSettings { calibration_depth: 1.5, minimum_required_seafloor_depth: 3.0, pitch_steps: 5, roll_steps: 4, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, manual_control: ManualControlSettings { default_force: 20.0, max_angular_velocity: 0.2, max_depth: 1.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.05, initial_pitch_setpoint_deg: 5.0, control_yaw_error: false }, move_to: MoveToSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, survey_area: SurveySettings { max_horizontal_distance_to_start_meters: None, default_velocity_meter_per_second: 0.4, maximum_velocity_meter_per_second: 1.5, min_current_magnitude_meter_per_second: 0.1, polygon_safety_scaling_factor: 1.02, max_initial_position_uncertainty_meters: 3.0 }, visibility_check: VisibilityCheckSettings { default_start_altitude: 3.0, default_end_altitude: 0.5, diving_velocity: 0.2, photo_interval: 0.1 } }, waiting_hold_duration_seconds: 300.0 } }
17:57:24.719 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "usbl_modem_location": [1.3235, 0.0, -0.09595], "camera_front_location": [1.1187, 0.0, 0.0066]})
17:57:24.719 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:57:24.721 INFO  [robot_code/utilities/simulator/src/simulator.rs:89] Initializing simulator with timestep: 20ms and simulator settings: SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }
17:57:24.837 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "usbl_modem_location": [1.3235, 0.0, -0.09595], "camera_front_location": [1.1187, 0.0, 0.0066]})
17:57:24.837 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:57:25.072 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "usbl_modem_location": [1.3235, 0.0, -0.09595], "camera_front_location": [1.1187, 0.0, 0.0066]})
17:57:25.072 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:57:25.072 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
17:57:25.072 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
17:57:25.072 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
17:57:25.073 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
17:57:25.073 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
17:57:25.073 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
17:57:25.073 WARN  [robot_code/robot_core/launch/src/lib.rs:570] IMU not enabled
17:57:25.073 WARN  [robot_code/robot_core/launch/src/lib.rs:588] Magnetometer not enabled
17:57:25.073 WARN  [robot_code/robot_core/launch/src/lib.rs:176] Magnetometer not enabled, state estimation will not be able to use it
17:57:25.073 WARN  [robot_code/robot_core/launch/src/lib.rs:627] Nortek DVL not enabled
17:57:25.073 WARN  [robot_code/robot_core/launch/src/lib.rs:606] GPS not enabled
17:57:25.073 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
17:57:25.073 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
17:57:25.073 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
17:57:25.073 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
17:57:25.074 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
17:57:25.075 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
17:57:25.076 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "usbl_modem_location": [1.3235, 0.0, -0.09595], "camera_front_location": [1.1187, 0.0, 0.0066]})
17:57:25.076 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:57:25.076 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'control' with StopRunningFlag { name: "control", id: 0, stop_running: false, do_auto_stop: true }
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
17:57:25.076 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 37214
17:57:25.077 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
17:57:25.077 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
17:57:25.077 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
17:57:25.077 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
17:57:25.087 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
17:57:25.087 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'simulator' with StopRunningFlag { name: "simulator", id: 0, stop_running: false, do_auto_stop: true }
17:57:25.087 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
17:57:25.087 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 37218
17:57:25.117 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
17:57:25.163 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
17:57:25.163 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
17:57:25.163 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'path_planner' with StopRunningFlag { name: "path_planner", id: 0, stop_running: false, do_auto_stop: true }
17:57:25.163 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
17:57:25.163 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
17:57:25.163 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
17:57:25.163 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 37220
17:57:25.183 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
17:57:25.183 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
17:57:25.183 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'task_scheduler' with StopRunningFlag { name: "task_scheduler", id: 0, stop_running: false, do_auto_stop: true }
17:57:25.184 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
17:57:25.184 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 37223
17:57:25.184 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
17:57:25.184 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
17:57:25.185 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for lora_module
17:57:25.185 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'lora_module' with StopRunningFlag { name: "lora_module", id: 0, stop_running: false, do_auto_stop: true }
17:57:25.185 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'lora_module' successfully started
17:57:25.185 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread lora_module with pid: 37274
17:57:25.186 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for outgoing_message
17:57:25.223 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
17:57:25.223 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:57:25.223 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
17:57:25.227 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"sensors": Object {"magnetometer": Object {"magA": Array [Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0)], "magB": Array [Number(0.0), Number(1.0), Number(0.0)]}}}
17:57:25.227 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'device_settings'. Description: Dynamic device specific settings. During runtime, these settings can be changed either by the user or by the robot itself.
17:57:25.229 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
17:57:25.229 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
17:57:25.231 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"camera": Object {"live_stitching": Null, "use_mocked": Bool(true)}, "communication": Object {"enabled": Bool(false), "identity": Object {"name": String("simulated_scout")}}, "robot": Object {"can_enabled": Bool(false), "logging_name": String("simulated_scout")}, "sensors": Object {"gps": Object {"enabled": Bool(false)}, "imu": Object {"enabled": Bool(false)}, "magnetometer": Object {"enabled": Bool(false)}, "nortek_dvl": Object {"enabled": Bool(false)}, "sonar": Object {"enabled": Bool(false), "tilt_degree": Number(15.0)}, "usbl": Null}, "simulator": Object {"bottom": String("flat"), "enable_user_debug_parameters": Bool(false), "gui": Bool(false), "multi_beam": Object {"fov": Number(120), "n_beams": Number(50), "pos": Array [Number(0.9), Number(0.0), Number(0.0)], "range": Number(15.0), "tilt": Number(20.0), "visualize_beams": Bool(true)}, "origin_latitude": Number(52.048187), "origin_longitude": Number(4.369903), "realtime": Bool(false), "scout_model": String("scout3"), "sea_floor_depth": Number(10.0), "sensor_noises": Object {"noise_scaling_factor": Number(1.0), "std_accelerometer": Number(0.02), "std_depth": Number(0.02), "std_dvl_beam_distance": Number(0.1), "std_dvl_velocity": Number(0.01), "std_gnss_receiver": Number(0.5), "std_gyroscope": Number(0.002), "std_magnetometer": Number(2.0)}, "start_attitude_euler_degrees": Array [Number(0.0), Number(0.0), Number(0.0)], "start_position": Array [Number(0), Number(0), Number(1)], "steps_per_second": Number(50), "water_current": Array [Number(0.0), Number(0.0), Number(0.0)]}}
17:57:25.231 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
17:57:25.234 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
17:57:25.234 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'communication' with StopRunningFlag { name: "communication", id: 0, stop_running: false, do_auto_stop: true }
17:57:25.234 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
17:57:25.234 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 37276
17:57:25.234 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
17:57:25.234 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
17:57:25.234 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:81] grpc listening on 0.0.0.0:10820
17:57:25.234 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
17:57:25.234 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
17:57:25.234 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Waiting until code stops running so threads can be joined
17:57:25.234 INFO  [robot_code/robot_core/launch/src/lib.rs:553] Trying to join thread 'control'
17:57:25.243 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:57:25.244 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:108] StopRunningFlag { name: "request_handling_toolbox", id: 0, stop_running: false, do_auto_stop: false } got dropped, but auto stop is disabled.
17:57:25.244 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'discovery_node' with StopRunningFlag { name: "discovery_node", id: 0, stop_running: false, do_auto_stop: false }
17:57:25.244 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
17:57:25.244 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 37279
17:57:25.244 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:155] Started watching interfaces
17:57:25.244 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:100] Sending heartbeat simulated_scout:318451712@[] to: ["192.168.30.255:10899", "255.255.255.255:10899"]
17:57:25.246 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for core_telemetry_stream
17:57:25.246 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for periodic_telemetry_stream
17:57:26.126 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.07Hz
17:57:27.130 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
17:57:28.134 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
17:57:29.138 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
17:57:30.143 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.76Hz
17:57:31.148 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.76Hz
17:57:32.153 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.72Hz
17:57:32.310 ERROR [/home/joris/.cargo/registry/src/index.crates.io-1949cf8c6b5b557f/log-panics-2.1.0/src/lib.rs:130] thread 'simulator' panicked at 'called `Result::unwrap()` on an `Err` value: Error { ctx: "Not connected to physics server" }': robot_code/utilities/simulator/src/pybullet_api.rs:152
   0: log_panics::Config::install_panic_hook::{{closure}}

17:58:30.896 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
17:58:30.896 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-06 17:58:30.896155278 +01:00
17:58:30.896 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
17:58:30.896 DEBUG [robot_code/utilities/logging/src/logging.rs:95] Logging initialized with handle: Handle { shared: ArcSwapAny(SharedLogger { root: ConfiguredLogger { level: Warn, appenders: [0, 1, 2, 3, 4], children: {"lobster_hardware_checks": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_camera": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_control": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sonar": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_payload": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_settings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_simulator": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_common": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_can": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_launch": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_logging": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_communication": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_live_stitching": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_state_estimation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sensors": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_actuation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_error_codes": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_usbl_driver": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_path_planning": ConfiguredLogger { level: Trace, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_task_scheduler": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_image_processing": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_python_bindings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_calibration": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_time": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }} }, appenders: [Appender { appender: ConsoleAppender { encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, do_write: true }, filters: [ThresholdFilter { level: Info }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Debug }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Error }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Warn }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 104857600 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
17:58:30.896 INFO  [robot_code/utilities/logging/src/logger_manager.rs:97] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_17-58-30_simulated_scout.lobsterlog")
17:58:30.902 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
17:58:30.903 INFO  [robot_code/robot_core/launch/src/lib.rs:130] Launching robot code with following settings:
Settings { actuation: ActuationSettings { max_current_change_per_second: 200.0, thruster_models: {"DD50_S3_tailcone_RPM": ThrusterModel { currents: [-28400.0, -27680.0, -24670.0, -22010.0, -18470.0, -14700.0, -9920.0, -6450.0, -1000.0, 1000.0, 6450.0, 9920.0, 14700.0, 18470.0, 22010.0, 24670.0, 27680.0, 28400.0], thrusts: [-26.24, -25.3, -21.31, -16.54, -12.3, -7.3, -2.64, -0.78, -0.01, 0.01, 0.78, 2.64, 7.3, 12.3, 16.54, 21.31, 25.3, 26.24] }, "DD80_S3_tailcone": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-36.15, -31.34, -26.1, -22.34, -17.71, -13.05, -7.8, -4.95, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 4.95, 7.8, 13.05, 17.71, 22.34, 26.1, 31.34, 36.15] }, "DD50_S3_tailcone": ThrusterModel { currents: [-25.0, -24.0, -22.0, -20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0, 22.0, 24.0, 25.0], thrusts: [-25.09, -23.83, -21.52, -19.0, -16.96, -15.1, -12.9, -11.11, -9.28, -7.05, -5.04, -2.79, -0.6, -0.01, 0.01, 0.78, 2.64, 4.89, 7.3, 9.9, 12.3, 14.44, 16.54, 18.76, 21.31, 23.6, 25.3, 26.24] }, "DD80_S3_tailcone_RPM": ThrusterModel { currents: [-19100.0, -16800.0, -15100.0, -13350.0, -11400.0, -9200.0, -6100.0, -3150.0, -1400.0, 1400.0, 3150.0, 6100.0, 9200.0, 11400.0, 13350.0, 15100.0, 16800.0, 19100.0], thrusts: [-65.6, -46.9, -36.15, -26.1, -17.71, -7.8, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 7.8, 17.71, 26.1, 36.15, 46.9, 65.6] }, "T500_S3_tailcone_basic_SLS_prop": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-42.03, -37.82, -33.02, -28.7, -24.7, -19.93, -16.03, -12.8, -8.0, -4.26, -0.001, 0.001, 3.06, 9.01, 14.23, 17.89, 22.8, 27.0, 32.66, 37.82, 42.8, 46.5] }}, thrusters: [ThrusterSettings { current_reversed: false, index: 7, model: "T500_S3_tailcone_basic_SLS_prop", name: "main_forwards", position: None, thruster_direction: [1.0, 0.0, 0.0], rpm_controlled: false }, ThrusterSettings { current_reversed: false, index: 6, model: "DD80_S3_tailcone_RPM", name: "rear_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 4, model: "DD50_S3_tailcone_RPM", name: "rear_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 5, model: "DD50_S3_tailcone_RPM", name: "rear_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 1, model: "DD80_S3_tailcone_RPM", name: "front_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 2, model: "DD50_S3_tailcone_RPM", name: "front_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 3, model: "DD50_S3_tailcone_RPM", name: "front_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }] }, camera: CameraSettings { exposure_control_settings_list: [ExposureControl { exposure_target: 0.3, exposure_target_quantile: 0.3, gain_margin: 3.0, gain_target: 5.0, name: "default" }, ExposureControl { exposure_target: 0.4, exposure_target_quantile: 0.95, gain_margin: 3.0, gain_target: 5.0, name: "highlights" }], stereo: false, lights: Some(Lights { temperature_sensors: {"nosecone": [218469099307008, 214543499198464], "tailcone": [144801820246016, 164593029545984]}, overheating_threshold: 50.0 }), use_mocked: true, use_hardware_triggers: true, vertical_fov_degrees: 51.4, live_stitching: None }, communication: CommunicationSettings { discovery_node: DiscoveryNodeSettings { broadcast_ips: [255.255.255.255, 192.168.30.255], broadcast_interfaces: [], broadcast_port: 10899 }, identity: IdentitySettings { name: "simulated_scout", serial_number: None, ip_addresses: [], usbl_id: 3 }, enabled: true, request_server: RequestServer { port: 10820 }, ui_settings_whitelist: ["actuation/max_current_change_per_second", "camera/use_mocked", "communication/world_model_update_frequency_hz", "control/frequency", "active_profile", "path_planner", "robot", "safety/min_cell_voltage", "safety/max_battery_temperature", "safety/min_altitude", "safety/max_altitude", "safety/altitude_safety_fallback_buffer", "safety/altitude_setpoint_buffer", "safety/max_expected_sea_floor_depth", "safety/min_expected_sea_floor_depth", "safety/max_update_dt", "safety/max_thruster_temp", "safety/max_thruster_disconnect_time", "safety/min_dvl_altitude_working", "safety/min_dvl_depth_working", "safety/max_roll_error_degrees", "safety/roll_safety_fallback_buffer_degrees", "safety/roll_safety_fallback_max_duration_seconds", "safety/max_pitch_error_degrees", "safety/max_position_error_meters", "sensors/imu/frequency", "sensors/nortek_dvl/start_measuring_pressure_only", "sensors/nortek_dvl/dvl_settings/led", "sensors/nortek_dvl/dvl_settings/record_199_data", "sensors/nortek_dvl/dvl_settings/measuring_mode", "sensors/nortek_dvl/dvl_settings/sample_rate", "sensors/nortek_dvl/dvl_settings/cp_sample_interval", "sensors/nortek_dvl/dvl_settings/salinity", "sensors/nortek_dvl/dvl_settings/bt_range", "sensors/nortek_dvl/dvl_settings/bt_max_along_beam_velocity", "state_estimation", "task_scheduler"], world_model_update_frequency_hz: 20.0 }, control: ControlSettings { frequency: 100.0, model: ControlModel { d_linear: [[2.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 40.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 40.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 1.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]], d_quadratic: [[55.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 400.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 400.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 4.882, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 80.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 80.0]], damping_x_asym: 0.0, m_a: [[2.27703, 0.0, 0.0, 0.0, -0.00977, -0.0], [0.0, 66.39192, 0.0, 0.07973, 0.0, -0.38227], [0.0, 0.0, 65.93975, 0.0, 0.4623, -0.0], [0.0, 0.07973, 0.0, 0.72, 0.0, 0.01411], [-0.00977, 0.0, 0.4623, 0.0, 19.17022, -0.0], [-0.0, -0.38227, -0.0, 0.01411, -0.0, 19.18307]], modules: Modules { module_configuration: ["scout_3"], modules: {"scout_3": ModuleInformation { center_of_mass: [1.00235121, 0.00123998, 0.00154298], center_of_volume: [0.99326563, -1.34e-6, -0.0], length: 1.91214, mass: 52.44353958, moment_of_inertia: [[0.26065892, 0.00607949, -0.00522948], [0.00607949, 12.7208684, 0.00011234], [-0.00522948, 0.00011234, 12.69270147]], name: "scout_3", poi: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "imu_location": [1.22915, -0.07144, -0.03025], "gps_location": [0.93573, 0.00255, -0.17048], "magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_rear_location": [0.9707, 0.0, 0.0066], "sonar_location": [1.81926, 0.0, 0.00717], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]}), volume: 0.053 }}, standard_hull_radius: 0.1, volume_error: 0.0 }, pos_co_b: [0.0, 0.0, 0.0], water_density: 997.0 }, pids: Pids { x_angular_velocity: PidParameters { kp: 14.0, ki: 1.0, kd: 0.3, min: -2.0, max: 2.0, cut_off_freq: 10.0 }, x_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.04, min: -1.0, max: 1.0, cut_off_freq: 10.0 }, x_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, x_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 5.0, min: -42.03, max: 46.5, cut_off_freq: 10.0 }, y_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, y_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, y_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, y_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 15.0, min: -50.0, max: 50.0, cut_off_freq: 10.0 }, z_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, z_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, z_position: PidParameters { kp: 1.5, ki: 0.0, kd: 0.075, min: -0.25, max: 0.25, cut_off_freq: 10.0 }, z_velocity: PidParameters { kp: 200.0, ki: 15.0, kd: 10.0, min: -40.0, max: 40.0, cut_off_freq: 10.0 } }, forward_roll_cross_coupling_gain: -0.02 }, path_planner: PathPlannerSettings { control_attitude_tolerance_degrees: 6.0, control_goal_timeout_seconds: 15, control_position_tolerance_meters: 0.1, control_request_timeout_millis: 100, desired_update_frequency: 40.0, fallback_survey_orientation_degrees: 0.0, max_time_to_wait_for_new_goal_seconds: 0.5, polygon_scaling_factor: 1.02, vertical_position_constraints: VerticalPositionConstraints { min_preferred_altitude: 3.0, min_preferred_depth: 5.0, min_required_altitude: 1.0, min_required_depth: 0.0, velocity_at_min_required_altitude: 0.5, velocity_at_min_required_depth: 0.9, velocity_in_preferred_range: 1.0, velocity_limit_depth: 10.0 }, strategy_planner_parameters: StrategyPlannerParameters { heading_deviation_threshold_degrees: 6.0, position_threshold_xy: 0.7, setpoint_radius_xy: 0.6, line_end_threshold: 0.1, low_velocity_threshold: 0.1, max_line_deviation_xy: 0.15, max_pitch_slope_degrees: 30.0, static_surface_depth: 0.1, motion_planner_parameters: MotionPlannerParameters { max_acceleration: [0.5, 0.1, 0.3], max_angular_acceleration: [0.5, 0.5, 0.5], max_angular_velocity: [0.5, 0.3, 0.3], max_deceleration: [0.4, 0.3, 0.3], max_velocity: [1.2, 0.2, 0.2] }, orientation_distance_threshold: 0.2, position_on_track_hysteresis: 0.1, timeout_delay_seconds: 60.0, timeout_delay_factor: 2.5, estimate_delay_seconds: 30.0, estimate_delay_factor: 1.5, position_threshold_z: 0.1 } }, robot: RobotSettings { logging_name: "simulated_scout", can_enabled: false, enable_thrusters: true }, safety: SafetySettings { altitude_safety_fallback_buffer: 0.1, altitude_setpoint_buffer: 0.1, max_altitude: 50.0, max_battery_temperature: 40.0, max_depth: 40.2, max_expected_sea_floor_depth: 45.0, max_pitch_error_degrees: 45.0, max_position_error_meters: 20.0, max_roll_error_degrees: 45.0, max_thruster_disconnect_time: 5.0, max_thruster_temp: 70.0, max_update_dt: 0.5, min_altitude: 0.3, min_cell_voltage: 3.4, min_dvl_altitude_working: 20.0, min_dvl_depth_working: 5.0, min_expected_sea_floor_depth: 0.0, roll_safety_fallback_buffer_degrees: 15.0, roll_safety_fallback_max_duration_seconds: 5.0 }, sensors: SensorSettings { gps: Gps { enabled: false }, imu: Imu { acc_a: [0.998631, 0.0, 0.0, 0.0, 0.998631, 0.0, 0.0, 0.0, 0.998631], acc_b: [0.0, 0.0, 0.0], enabled: false, filter_low_pass_3_db_frequency: 20.0, frequency: 250.0, gyro_b: [-0.000357, 0.000623, 0.001831], name: Adis164753, orientation: [0.0, 1.0, 0.0, 0.0, 0.0, 1.0, 1.0, 0.0, 0.0] }, magnetometer: Magnetometer { enabled: false, mag_a: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0], mag_b: [0.0, 1.0, 0.0], orientation: [1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, -1.0, 0.0] }, nortek_dvl: NortekDvl { command_port_timeout_millis: 2000, data_port_timeout_millis: 500, dvl_settings: DvlSettings { bt_blanking_distance: 0.06, bt_max_along_beam_velocity: 5.0, bt_range: 50.0, bt_settings_raw: "NB=4,CH=0,DF=21,PL=0.0,WTDF=22,PLMODE=\"MAX\"", cp_blanking_distance: 1.0, cp_cell_size: 1.0, cp_number_of_cells: 30, cp_sample_interval: 10, cp_settings_raw: "CY=\"XYZ\",PL=0.0,VP=0.000,VR=2.50,DF=3,NB=4,CH=0", do_fast_pressure: true, do_water_track: false, dvl_settings_raw: "TRIG=\"INTSR\",FN=\"\",SV=0,ALTI=0,FASTTRIG=1", fast_pressure_sample_rate: 30, fast_pressure_settings_raw: "DF=41", initial_pressure_offset: 9.51, instrument_yaw: 0.0, led: false, measuring_mode: Auto, record_199_data: false, salinity: 35.0, sample_rate: 8.0 }, enabled: false, host: "192.168.30.102", id: 106006, start_measuring_pressure_only: false }, sonar: Sonar { enabled: false, tilt_degree: 15.0 }, usbl: None }, active_profile: Default, simulator: Some(SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }), state_estimation: StateEstimationSettings { depth_samples_max_timeout_millis: 10000, external_disturbance_heading_valid_time_minutes: 60.0, gnss_samples_use_one_in_n: 8, seafloor_depth_smoothing_factor: 0.7, magnetic_field_strength_deviation: 4.0 }, task_scheduler: TaskSchedulerSettings { preparing_behavior: PreparationModeBehavior { max_number_gps_tasks: 2, max_number_move_to_start_tasks: 2 }, desired_update_frequency: 50.0, excessive_current_handling: ExcessiveCurrentParams { lateral_disturbance_threshold: 0.9, lateral_velocity_threshold: 0.07, time_threshold: 10.0, trigger_check_period_seconds: 0.1, trigger_count_limit_per_survey: 5, max_time_to_disable_preparation_tasks_minutes: 10.0 }, task_settings: TaskSettings { max_horizontal_distance_to_start_meters: 300.0, buoyancy_calibration: BuoyancyCalibrationSettings { calibration_depth: 1.0, minimum_required_seafloor_depth: 2.0, pitch_step_degrees: 20.0, roll_step_degrees: 20.0, step_duration_seconds: 20.0, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, external_disturbance_estimation: ExternalDisturbanceEstimationSettings { acceptable_normalized_lateral_disturbance: 0.4, lateral_disturbance_optimization_threshold: 0.05, longitudinal_disturbance_direction_threshold: 0.1, min_binary_search_step_size_degrees: 3.0, minimum_task_depth_meters: 1.0, wait_between_steps_seconds: 30.0 }, get_gps: GetGpsSettings { max_duration_seconds: 300.0, step_duration_seconds: 2.0, minimum_uncertainty_meters: 1.0, ascend_position_control_disable_depth: 1.5 }, hold: HoldSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, magnetometer_calibration: MagnetometerCalibrationSettings { calibration_depth: 1.5, minimum_required_seafloor_depth: 3.0, pitch_steps: 5, roll_steps: 4, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, manual_control: ManualControlSettings { default_force: 20.0, max_angular_velocity: 0.2, max_depth: 1.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.05, initial_pitch_setpoint_deg: 5.0, control_yaw_error: false }, move_to: MoveToSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, survey_area: SurveySettings { max_horizontal_distance_to_start_meters: None, default_velocity_meter_per_second: 0.4, maximum_velocity_meter_per_second: 1.5, min_current_magnitude_meter_per_second: 0.1, polygon_safety_scaling_factor: 1.02, max_initial_position_uncertainty_meters: 3.0 }, visibility_check: VisibilityCheckSettings { default_start_altitude: 3.0, default_end_altitude: 0.5, diving_velocity: 0.2, photo_interval: 0.1 } }, waiting_hold_duration_seconds: 300.0 } }
17:58:30.983 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "imu_location": [1.22915, -0.07144, -0.03025], "gps_location": [0.93573, 0.00255, -0.17048], "magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_rear_location": [0.9707, 0.0, 0.0066], "sonar_location": [1.81926, 0.0, 0.00717], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]})
17:58:30.983 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:58:30.984 INFO  [robot_code/utilities/simulator/src/simulator.rs:89] Initializing simulator with timestep: 20ms and simulator settings: SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }
17:58:31.106 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "imu_location": [1.22915, -0.07144, -0.03025], "gps_location": [0.93573, 0.00255, -0.17048], "magnetometer_location": [1.06914, 0.00188, -0.20086], "camera_rear_location": [0.9707, 0.0, 0.0066], "sonar_location": [1.81926, 0.0, 0.00717], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "dvl_location": [1.3305, 0.0, 0.0176], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "ps_location": [1.28577, 0.0, 0.06725], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]})
17:58:31.106 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:58:31.469 ERROR [/home/joris/.cargo/registry/src/index.crates.io-1949cf8c6b5b557f/log-panics-2.1.0/src/lib.rs:130] thread 'main' panicked at 'None': robot_code/utilities/simulator/src/auv.rs:100
   0: log_panics::Config::install_panic_hook::{{closure}}

17:59:18.323 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
17:59:18.323 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-06 17:59:18.323561783 +01:00
17:59:18.323 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
17:59:18.323 DEBUG [robot_code/utilities/logging/src/logging.rs:95] Logging initialized with handle: Handle { shared: ArcSwapAny(SharedLogger { root: ConfiguredLogger { level: Warn, appenders: [0, 1, 2, 3, 4], children: {"lobster_hardware_checks": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_camera": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_control": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sonar": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_payload": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_settings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_simulator": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_common": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_can": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_launch": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_logging": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_communication": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_live_stitching": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_state_estimation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sensors": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_actuation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_error_codes": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_usbl_driver": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_path_planning": ConfiguredLogger { level: Trace, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_task_scheduler": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_image_processing": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_python_bindings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_calibration": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_time": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }} }, appenders: [Appender { appender: ConsoleAppender { encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, do_write: true }, filters: [ThresholdFilter { level: Info }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Debug }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Error }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Warn }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 104857600 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
17:59:18.323 INFO  [robot_code/utilities/logging/src/logger_manager.rs:97] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_17-59-18_simulated_scout.lobsterlog")
17:59:18.330 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
17:59:18.331 INFO  [robot_code/robot_core/launch/src/lib.rs:130] Launching robot code with following settings:
Settings { actuation: ActuationSettings { max_current_change_per_second: 200.0, thruster_models: {"T500_S3_tailcone_basic_SLS_prop": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-42.03, -37.82, -33.02, -28.7, -24.7, -19.93, -16.03, -12.8, -8.0, -4.26, -0.001, 0.001, 3.06, 9.01, 14.23, 17.89, 22.8, 27.0, 32.66, 37.82, 42.8, 46.5] }, "DD50_S3_tailcone": ThrusterModel { currents: [-25.0, -24.0, -22.0, -20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0, 22.0, 24.0, 25.0], thrusts: [-25.09, -23.83, -21.52, -19.0, -16.96, -15.1, -12.9, -11.11, -9.28, -7.05, -5.04, -2.79, -0.6, -0.01, 0.01, 0.78, 2.64, 4.89, 7.3, 9.9, 12.3, 14.44, 16.54, 18.76, 21.31, 23.6, 25.3, 26.24] }, "DD80_S3_tailcone": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-36.15, -31.34, -26.1, -22.34, -17.71, -13.05, -7.8, -4.95, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 4.95, 7.8, 13.05, 17.71, 22.34, 26.1, 31.34, 36.15] }, "DD50_S3_tailcone_RPM": ThrusterModel { currents: [-28400.0, -27680.0, -24670.0, -22010.0, -18470.0, -14700.0, -9920.0, -6450.0, -1000.0, 1000.0, 6450.0, 9920.0, 14700.0, 18470.0, 22010.0, 24670.0, 27680.0, 28400.0], thrusts: [-26.24, -25.3, -21.31, -16.54, -12.3, -7.3, -2.64, -0.78, -0.01, 0.01, 0.78, 2.64, 7.3, 12.3, 16.54, 21.31, 25.3, 26.24] }, "DD80_S3_tailcone_RPM": ThrusterModel { currents: [-19100.0, -16800.0, -15100.0, -13350.0, -11400.0, -9200.0, -6100.0, -3150.0, -1400.0, 1400.0, 3150.0, 6100.0, 9200.0, 11400.0, 13350.0, 15100.0, 16800.0, 19100.0], thrusts: [-65.6, -46.9, -36.15, -26.1, -17.71, -7.8, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 7.8, 17.71, 26.1, 36.15, 46.9, 65.6] }}, thrusters: [ThrusterSettings { current_reversed: false, index: 7, model: "T500_S3_tailcone_basic_SLS_prop", name: "main_forwards", position: None, thruster_direction: [1.0, 0.0, 0.0], rpm_controlled: false }, ThrusterSettings { current_reversed: false, index: 6, model: "DD80_S3_tailcone_RPM", name: "rear_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 4, model: "DD50_S3_tailcone_RPM", name: "rear_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 5, model: "DD50_S3_tailcone_RPM", name: "rear_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 1, model: "DD80_S3_tailcone_RPM", name: "front_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 2, model: "DD50_S3_tailcone_RPM", name: "front_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 3, model: "DD50_S3_tailcone_RPM", name: "front_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }] }, camera: CameraSettings { exposure_control_settings_list: [ExposureControl { exposure_target: 0.3, exposure_target_quantile: 0.3, gain_margin: 3.0, gain_target: 5.0, name: "default" }, ExposureControl { exposure_target: 0.4, exposure_target_quantile: 0.95, gain_margin: 3.0, gain_target: 5.0, name: "highlights" }], stereo: false, lights: Some(Lights { temperature_sensors: {"tailcone": [144801820246016, 164593029545984], "nosecone": [218469099307008, 214543499198464]}, overheating_threshold: 50.0 }), use_mocked: true, use_hardware_triggers: true, vertical_fov_degrees: 51.4, live_stitching: None }, communication: CommunicationSettings { discovery_node: DiscoveryNodeSettings { broadcast_ips: [255.255.255.255, 192.168.30.255], broadcast_interfaces: [], broadcast_port: 10899 }, identity: IdentitySettings { name: "simulated_scout", serial_number: None, ip_addresses: [], usbl_id: 3 }, enabled: true, request_server: RequestServer { port: 10820 }, ui_settings_whitelist: ["actuation/max_current_change_per_second", "camera/use_mocked", "communication/world_model_update_frequency_hz", "control/frequency", "active_profile", "path_planner", "robot", "safety/min_cell_voltage", "safety/max_battery_temperature", "safety/min_altitude", "safety/max_altitude", "safety/altitude_safety_fallback_buffer", "safety/altitude_setpoint_buffer", "safety/max_expected_sea_floor_depth", "safety/min_expected_sea_floor_depth", "safety/max_update_dt", "safety/max_thruster_temp", "safety/max_thruster_disconnect_time", "safety/min_dvl_altitude_working", "safety/min_dvl_depth_working", "safety/max_roll_error_degrees", "safety/roll_safety_fallback_buffer_degrees", "safety/roll_safety_fallback_max_duration_seconds", "safety/max_pitch_error_degrees", "safety/max_position_error_meters", "sensors/imu/frequency", "sensors/nortek_dvl/start_measuring_pressure_only", "sensors/nortek_dvl/dvl_settings/led", "sensors/nortek_dvl/dvl_settings/record_199_data", "sensors/nortek_dvl/dvl_settings/measuring_mode", "sensors/nortek_dvl/dvl_settings/sample_rate", "sensors/nortek_dvl/dvl_settings/cp_sample_interval", "sensors/nortek_dvl/dvl_settings/salinity", "sensors/nortek_dvl/dvl_settings/bt_range", "sensors/nortek_dvl/dvl_settings/bt_max_along_beam_velocity", "state_estimation", "task_scheduler"], world_model_update_frequency_hz: 20.0 }, control: ControlSettings { frequency: 100.0, model: ControlModel { d_linear: [[2.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 40.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 40.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 1.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]], d_quadratic: [[55.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 400.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 400.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 4.882, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 80.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 80.0]], damping_x_asym: 0.0, m_a: [[2.27703, 0.0, 0.0, 0.0, -0.00977, -0.0], [0.0, 66.39192, 0.0, 0.07973, 0.0, -0.38227], [0.0, 0.0, 65.93975, 0.0, 0.4623, -0.0], [0.0, 0.07973, 0.0, 0.72, 0.0, 0.01411], [-0.00977, 0.0, 0.4623, 0.0, 19.17022, -0.0], [-0.0, -0.38227, -0.0, 0.01411, -0.0, 19.18307]], modules: Modules { module_configuration: ["scout_3"], modules: {"scout_3": ModuleInformation { center_of_mass: [1.00235121, 0.00123998, 0.00154298], center_of_volume: [0.99326563, -1.34e-6, -0.0], length: 1.91214, mass: 52.44353958, moment_of_inertia: [[0.26065892, 0.00607949, -0.00522948], [0.00607949, 12.7208684, 0.00011234], [-0.00522948, 0.00011234, 12.69270147]], name: "scout_3", poi: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "camera_front_location": [1.1187, 0.0, 0.0066], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "dvl_location": [1.3305, 0.0, 0.0176], "imu_location": [1.22915, -0.07144, -0.03025]}), volume: 0.053 }}, standard_hull_radius: 0.1, volume_error: 0.0 }, pos_co_b: [0.0, 0.0, 0.0], water_density: 997.0 }, pids: Pids { x_angular_velocity: PidParameters { kp: 14.0, ki: 1.0, kd: 0.3, min: -2.0, max: 2.0, cut_off_freq: 10.0 }, x_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.04, min: -1.0, max: 1.0, cut_off_freq: 10.0 }, x_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, x_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 5.0, min: -42.03, max: 46.5, cut_off_freq: 10.0 }, y_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, y_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, y_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, y_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 15.0, min: -50.0, max: 50.0, cut_off_freq: 10.0 }, z_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, z_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, z_position: PidParameters { kp: 1.5, ki: 0.0, kd: 0.075, min: -0.25, max: 0.25, cut_off_freq: 10.0 }, z_velocity: PidParameters { kp: 200.0, ki: 15.0, kd: 10.0, min: -40.0, max: 40.0, cut_off_freq: 10.0 } }, forward_roll_cross_coupling_gain: -0.02 }, path_planner: PathPlannerSettings { control_attitude_tolerance_degrees: 6.0, control_goal_timeout_seconds: 15, control_position_tolerance_meters: 0.1, control_request_timeout_millis: 100, desired_update_frequency: 40.0, fallback_survey_orientation_degrees: 0.0, max_time_to_wait_for_new_goal_seconds: 0.5, polygon_scaling_factor: 1.02, vertical_position_constraints: VerticalPositionConstraints { min_preferred_altitude: 3.0, min_preferred_depth: 5.0, min_required_altitude: 1.0, min_required_depth: 0.0, velocity_at_min_required_altitude: 0.5, velocity_at_min_required_depth: 0.9, velocity_in_preferred_range: 1.0, velocity_limit_depth: 10.0 }, strategy_planner_parameters: StrategyPlannerParameters { heading_deviation_threshold_degrees: 6.0, position_threshold_xy: 0.7, setpoint_radius_xy: 0.6, line_end_threshold: 0.1, low_velocity_threshold: 0.1, max_line_deviation_xy: 0.15, max_pitch_slope_degrees: 30.0, static_surface_depth: 0.1, motion_planner_parameters: MotionPlannerParameters { max_acceleration: [0.5, 0.1, 0.3], max_angular_acceleration: [0.5, 0.5, 0.5], max_angular_velocity: [0.5, 0.3, 0.3], max_deceleration: [0.4, 0.3, 0.3], max_velocity: [1.2, 0.2, 0.2] }, orientation_distance_threshold: 0.2, position_on_track_hysteresis: 0.1, timeout_delay_seconds: 60.0, timeout_delay_factor: 2.5, estimate_delay_seconds: 30.0, estimate_delay_factor: 1.5, position_threshold_z: 0.1 } }, robot: RobotSettings { logging_name: "simulated_scout", can_enabled: false, enable_thrusters: true }, safety: SafetySettings { altitude_safety_fallback_buffer: 0.1, altitude_setpoint_buffer: 0.1, max_altitude: 50.0, max_battery_temperature: 40.0, max_depth: 40.2, max_expected_sea_floor_depth: 45.0, max_pitch_error_degrees: 45.0, max_position_error_meters: 20.0, max_roll_error_degrees: 45.0, max_thruster_disconnect_time: 5.0, max_thruster_temp: 70.0, max_update_dt: 0.5, min_altitude: 0.3, min_cell_voltage: 3.4, min_dvl_altitude_working: 20.0, min_dvl_depth_working: 5.0, min_expected_sea_floor_depth: 0.0, roll_safety_fallback_buffer_degrees: 15.0, roll_safety_fallback_max_duration_seconds: 5.0 }, sensors: SensorSettings { gps: Gps { enabled: false }, imu: Imu { acc_a: [0.998631, 0.0, 0.0, 0.0, 0.998631, 0.0, 0.0, 0.0, 0.998631], acc_b: [0.0, 0.0, 0.0], enabled: false, filter_low_pass_3_db_frequency: 20.0, frequency: 250.0, gyro_b: [-0.000357, 0.000623, 0.001831], name: Adis164753, orientation: [0.0, 1.0, 0.0, 0.0, 0.0, 1.0, 1.0, 0.0, 0.0] }, magnetometer: Magnetometer { enabled: false, mag_a: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0], mag_b: [0.0, 1.0, 0.0], orientation: [1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, -1.0, 0.0] }, nortek_dvl: NortekDvl { command_port_timeout_millis: 2000, data_port_timeout_millis: 500, dvl_settings: DvlSettings { bt_blanking_distance: 0.06, bt_max_along_beam_velocity: 5.0, bt_range: 50.0, bt_settings_raw: "NB=4,CH=0,DF=21,PL=0.0,WTDF=22,PLMODE=\"MAX\"", cp_blanking_distance: 1.0, cp_cell_size: 1.0, cp_number_of_cells: 30, cp_sample_interval: 10, cp_settings_raw: "CY=\"XYZ\",PL=0.0,VP=0.000,VR=2.50,DF=3,NB=4,CH=0", do_fast_pressure: true, do_water_track: false, dvl_settings_raw: "TRIG=\"INTSR\",FN=\"\",SV=0,ALTI=0,FASTTRIG=1", fast_pressure_sample_rate: 30, fast_pressure_settings_raw: "DF=41", initial_pressure_offset: 9.51, instrument_yaw: 0.0, led: false, measuring_mode: Auto, record_199_data: false, salinity: 35.0, sample_rate: 8.0 }, enabled: false, host: "192.168.30.102", id: 106006, start_measuring_pressure_only: false }, sonar: Sonar { enabled: false, tilt_degree: 15.0 }, usbl: None }, active_profile: Default, simulator: Some(SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }), state_estimation: StateEstimationSettings { depth_samples_max_timeout_millis: 10000, external_disturbance_heading_valid_time_minutes: 60.0, gnss_samples_use_one_in_n: 8, seafloor_depth_smoothing_factor: 0.7, magnetic_field_strength_deviation: 4.0 }, task_scheduler: TaskSchedulerSettings { preparing_behavior: PreparationModeBehavior { max_number_gps_tasks: 2, max_number_move_to_start_tasks: 2 }, desired_update_frequency: 50.0, excessive_current_handling: ExcessiveCurrentParams { lateral_disturbance_threshold: 0.9, lateral_velocity_threshold: 0.07, time_threshold: 10.0, trigger_check_period_seconds: 0.1, trigger_count_limit_per_survey: 5, max_time_to_disable_preparation_tasks_minutes: 10.0 }, task_settings: TaskSettings { max_horizontal_distance_to_start_meters: 300.0, buoyancy_calibration: BuoyancyCalibrationSettings { calibration_depth: 1.0, minimum_required_seafloor_depth: 2.0, pitch_step_degrees: 20.0, roll_step_degrees: 20.0, step_duration_seconds: 20.0, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, external_disturbance_estimation: ExternalDisturbanceEstimationSettings { acceptable_normalized_lateral_disturbance: 0.4, lateral_disturbance_optimization_threshold: 0.05, longitudinal_disturbance_direction_threshold: 0.1, min_binary_search_step_size_degrees: 3.0, minimum_task_depth_meters: 1.0, wait_between_steps_seconds: 30.0 }, get_gps: GetGpsSettings { max_duration_seconds: 300.0, step_duration_seconds: 2.0, minimum_uncertainty_meters: 1.0, ascend_position_control_disable_depth: 1.5 }, hold: HoldSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, magnetometer_calibration: MagnetometerCalibrationSettings { calibration_depth: 1.5, minimum_required_seafloor_depth: 3.0, pitch_steps: 5, roll_steps: 4, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, manual_control: ManualControlSettings { default_force: 20.0, max_angular_velocity: 0.2, max_depth: 1.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.05, initial_pitch_setpoint_deg: 5.0, control_yaw_error: false }, move_to: MoveToSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, survey_area: SurveySettings { max_horizontal_distance_to_start_meters: None, default_velocity_meter_per_second: 0.4, maximum_velocity_meter_per_second: 1.5, min_current_magnitude_meter_per_second: 0.1, polygon_safety_scaling_factor: 1.02, max_initial_position_uncertainty_meters: 3.0 }, visibility_check: VisibilityCheckSettings { default_start_altitude: 3.0, default_end_altitude: 0.5, diving_velocity: 0.2, photo_interval: 0.1 } }, waiting_hold_duration_seconds: 300.0 } }
17:59:18.403 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "camera_front_location": [1.1187, 0.0, 0.0066], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "dvl_location": [1.3305, 0.0, 0.0176], "imu_location": [1.22915, -0.07144, -0.03025]})
17:59:18.403 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:18.405 INFO  [robot_code/utilities/simulator/src/simulator.rs:89] Initializing simulator with timestep: 20ms and simulator settings: SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }
17:59:18.538 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "camera_front_location": [1.1187, 0.0, 0.0066], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "dvl_location": [1.3305, 0.0, 0.0176], "imu_location": [1.22915, -0.07144, -0.03025]})
17:59:18.539 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:18.960 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "camera_front_location": [1.1187, 0.0, 0.0066], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "dvl_location": [1.3305, 0.0, 0.0176], "imu_location": [1.22915, -0.07144, -0.03025]})
17:59:18.960 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:18.960 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
17:59:18.960 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
17:59:18.961 WARN  [robot_code/robot_core/launch/src/lib.rs:570] IMU not enabled
17:59:18.961 WARN  [robot_code/robot_core/launch/src/lib.rs:588] Magnetometer not enabled
17:59:18.961 WARN  [robot_code/robot_core/launch/src/lib.rs:176] Magnetometer not enabled, state estimation will not be able to use it
17:59:18.961 WARN  [robot_code/robot_core/launch/src/lib.rs:627] Nortek DVL not enabled
17:59:18.961 WARN  [robot_code/robot_core/launch/src/lib.rs:606] GPS not enabled
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
17:59:18.961 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
17:59:18.961 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
17:59:18.962 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
17:59:18.963 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
17:59:18.963 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
17:59:18.963 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
17:59:18.963 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
17:59:18.963 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
17:59:18.963 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
17:59:18.964 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
17:59:18.965 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
17:59:18.965 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
17:59:18.965 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"magnetometer_location": [1.06914, 0.00188, -0.20086], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "camera_front_location": [1.1187, 0.0, 0.0066], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "usbl_modem_location": [1.3235, 0.0, -0.09595], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "dvl_location": [1.3305, 0.0, 0.0176], "imu_location": [1.22915, -0.07144, -0.03025]})
17:59:18.965 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:18.965 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
17:59:18.965 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'control' with StopRunningFlag { name: "control", id: 0, stop_running: false, do_auto_stop: true }
17:59:18.965 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
17:59:18.965 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
17:59:18.965 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 59051
17:59:18.965 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
17:59:18.965 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
17:59:18.966 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
17:59:18.966 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
17:59:18.975 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
17:59:18.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'simulator' with StopRunningFlag { name: "simulator", id: 0, stop_running: false, do_auto_stop: true }
17:59:18.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
17:59:18.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 59055
17:59:19.005 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
17:59:19.044 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
17:59:19.044 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
17:59:19.044 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'path_planner' with StopRunningFlag { name: "path_planner", id: 0, stop_running: false, do_auto_stop: true }
17:59:19.045 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
17:59:19.045 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
17:59:19.045 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
17:59:19.045 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 59057
17:59:19.065 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
17:59:19.065 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
17:59:19.065 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'task_scheduler' with StopRunningFlag { name: "task_scheduler", id: 0, stop_running: false, do_auto_stop: true }
17:59:19.065 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
17:59:19.065 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 59060
17:59:19.066 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
17:59:19.066 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
17:59:19.067 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for lora_module
17:59:19.067 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'lora_module' with StopRunningFlag { name: "lora_module", id: 0, stop_running: false, do_auto_stop: true }
17:59:19.067 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'lora_module' successfully started
17:59:19.067 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread lora_module with pid: 59111
17:59:19.067 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for outgoing_message
17:59:19.105 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
17:59:19.105 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:59:19.105 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
17:59:19.108 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"sensors": Object {"magnetometer": Object {"magA": Array [Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0)], "magB": Array [Number(0.0), Number(1.0), Number(0.0)]}}}
17:59:19.108 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'device_settings'. Description: Dynamic device specific settings. During runtime, these settings can be changed either by the user or by the robot itself.
17:59:19.110 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
17:59:19.110 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
17:59:19.112 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"camera": Object {"live_stitching": Null, "use_mocked": Bool(true)}, "communication": Object {"enabled": Bool(false), "identity": Object {"name": String("simulated_scout")}}, "robot": Object {"can_enabled": Bool(false), "logging_name": String("simulated_scout")}, "sensors": Object {"gps": Object {"enabled": Bool(false)}, "imu": Object {"enabled": Bool(false)}, "magnetometer": Object {"enabled": Bool(false)}, "nortek_dvl": Object {"enabled": Bool(false)}, "sonar": Object {"enabled": Bool(false), "tilt_degree": Number(15.0)}, "usbl": Null}, "simulator": Object {"bottom": String("flat"), "enable_user_debug_parameters": Bool(false), "gui": Bool(false), "multi_beam": Object {"fov": Number(120), "n_beams": Number(50), "pos": Array [Number(0.9), Number(0.0), Number(0.0)], "range": Number(15.0), "tilt": Number(20.0), "visualize_beams": Bool(true)}, "origin_latitude": Number(52.048187), "origin_longitude": Number(4.369903), "realtime": Bool(false), "scout_model": String("scout3"), "sea_floor_depth": Number(10.0), "sensor_noises": Object {"noise_scaling_factor": Number(1.0), "std_accelerometer": Number(0.02), "std_depth": Number(0.02), "std_dvl_beam_distance": Number(0.1), "std_dvl_velocity": Number(0.01), "std_gnss_receiver": Number(0.5), "std_gyroscope": Number(0.002), "std_magnetometer": Number(2.0)}, "start_attitude_euler_degrees": Array [Number(0.0), Number(0.0), Number(0.0)], "start_position": Array [Number(0), Number(0), Number(1)], "steps_per_second": Number(50), "water_current": Array [Number(0.0), Number(0.0), Number(0.0)]}}
17:59:19.112 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
17:59:19.114 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
17:59:19.114 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'communication' with StopRunningFlag { name: "communication", id: 0, stop_running: false, do_auto_stop: true }
17:59:19.114 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
17:59:19.114 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 59113
17:59:19.114 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
17:59:19.114 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
17:59:19.114 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:81] grpc listening on 0.0.0.0:10820
17:59:19.115 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
17:59:19.115 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
17:59:19.115 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Waiting until code stops running so threads can be joined
17:59:19.115 INFO  [robot_code/robot_core/launch/src/lib.rs:553] Trying to join thread 'control'
17:59:19.125 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:59:19.125 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:108] StopRunningFlag { name: "request_handling_toolbox", id: 0, stop_running: false, do_auto_stop: false } got dropped, but auto stop is disabled.
17:59:19.125 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'discovery_node' with StopRunningFlag { name: "discovery_node", id: 0, stop_running: false, do_auto_stop: false }
17:59:19.125 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
17:59:19.126 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 59116
17:59:19.126 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:155] Started watching interfaces
17:59:19.126 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:100] Sending heartbeat simulated_scout:318451712@[] to: ["255.255.255.255:10899", "192.168.30.255:10899"]
17:59:19.129 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for core_telemetry_stream
17:59:19.129 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for periodic_telemetry_stream
17:59:20.008 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.40Hz
17:59:21.012 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
17:59:21.158 ERROR [/home/joris/.cargo/registry/src/index.crates.io-1949cf8c6b5b557f/log-panics-2.1.0/src/lib.rs:130] thread 'simulator' panicked at 'called `Result::unwrap()` on an `Err` value: Error { ctx: "Not connected to physics server" }': robot_code/utilities/simulator/src/pybullet_api.rs:152
   0: log_panics::Config::install_panic_hook::{{closure}}

17:59:31.823 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
17:59:31.823 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-06 17:59:31.823846566 +01:00
17:59:31.823 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
17:59:31.823 DEBUG [robot_code/utilities/logging/src/logging.rs:95] Logging initialized with handle: Handle { shared: ArcSwapAny(SharedLogger { root: ConfiguredLogger { level: Warn, appenders: [0, 1, 2, 3, 4], children: {"lobster_hardware_checks": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_camera": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_control": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sonar": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_payload": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_settings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_simulator": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_common": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_can": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_launch": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_logging": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_communication": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_live_stitching": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_state_estimation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_sensors": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_actuation": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_error_codes": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_usbl_driver": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_path_planning": ConfiguredLogger { level: Trace, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_task_scheduler": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_image_processing": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_python_bindings": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_calibration": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }, "lobster_time": ConfiguredLogger { level: Debug, appenders: [0, 1, 2, 3, 4], children: {} }} }, appenders: [Appender { appender: ConsoleAppender { encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, do_write: true }, filters: [ThresholdFilter { level: Info }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Debug }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.error.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Error }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 52428800 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.warn.log.{}", compression: None, base: 0, count: 20 } } }, filters: [ThresholdFilter { level: Warn }] }, Appender { appender: RollingFileAppender { path: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log", append: true, encoder: PatternEncoder { pattern: "{d(%H:%M:%S%.3f)} {h({({l}):5.5})} [{f}:{L}] {m}{n}" }, policy: CompoundPolicy { trigger: SizeTrigger { limit: 104857600 }, roller: FixedWindowRoller { pattern: "/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
17:59:31.823 INFO  [robot_code/utilities/logging/src/logger_manager.rs:97] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-06_simulated_scout/2025-11-06_17-59-31_simulated_scout.lobsterlog")
17:59:31.826 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
17:59:31.827 INFO  [robot_code/robot_core/launch/src/lib.rs:130] Launching robot code with following settings:
Settings { actuation: ActuationSettings { max_current_change_per_second: 200.0, thruster_models: {"T500_S3_tailcone_basic_SLS_prop": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-42.03, -37.82, -33.02, -28.7, -24.7, -19.93, -16.03, -12.8, -8.0, -4.26, -0.001, 0.001, 3.06, 9.01, 14.23, 17.89, 22.8, 27.0, 32.66, 37.82, 42.8, 46.5] }, "DD80_S3_tailcone": ThrusterModel { currents: [-20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0], thrusts: [-36.15, -31.34, -26.1, -22.34, -17.71, -13.05, -7.8, -4.95, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 4.95, 7.8, 13.05, 17.71, 22.34, 26.1, 31.34, 36.15] }, "DD50_S3_tailcone_RPM": ThrusterModel { currents: [-28400.0, -27680.0, -24670.0, -22010.0, -18470.0, -14700.0, -9920.0, -6450.0, -1000.0, 1000.0, 6450.0, 9920.0, 14700.0, 18470.0, 22010.0, 24670.0, 27680.0, 28400.0], thrusts: [-26.24, -25.3, -21.31, -16.54, -12.3, -7.3, -2.64, -0.78, -0.01, 0.01, 0.78, 2.64, 7.3, 12.3, 16.54, 21.31, 25.3, 26.24] }, "DD80_S3_tailcone_RPM": ThrusterModel { currents: [-19100.0, -16800.0, -15100.0, -13350.0, -11400.0, -9200.0, -6100.0, -3150.0, -1400.0, 1400.0, 3150.0, 6100.0, 9200.0, 11400.0, 13350.0, 15100.0, 16800.0, 19100.0], thrusts: [-65.6, -46.9, -36.15, -26.1, -17.71, -7.8, -2.77, -0.73, -0.01, 0.01, 0.73, 2.77, 7.8, 17.71, 26.1, 36.15, 46.9, 65.6] }, "DD50_S3_tailcone": ThrusterModel { currents: [-25.0, -24.0, -22.0, -20.0, -18.0, -16.0, -14.0, -12.0, -10.0, -8.0, -6.0, -4.0, -2.0, -0.3, 0.3, 2.0, 4.0, 6.0, 8.0, 10.0, 12.0, 14.0, 16.0, 18.0, 20.0, 22.0, 24.0, 25.0], thrusts: [-25.09, -23.83, -21.52, -19.0, -16.96, -15.1, -12.9, -11.11, -9.28, -7.05, -5.04, -2.79, -0.6, -0.01, 0.01, 0.78, 2.64, 4.89, 7.3, 9.9, 12.3, 14.44, 16.54, 18.76, 21.31, 23.6, 25.3, 26.24] }}, thrusters: [ThrusterSettings { current_reversed: false, index: 7, model: "T500_S3_tailcone_basic_SLS_prop", name: "main_forwards", position: None, thruster_direction: [1.0, 0.0, 0.0], rpm_controlled: false }, ThrusterSettings { current_reversed: false, index: 6, model: "DD80_S3_tailcone_RPM", name: "rear_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 4, model: "DD50_S3_tailcone_RPM", name: "rear_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 5, model: "DD50_S3_tailcone_RPM", name: "rear_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 1, model: "DD80_S3_tailcone_RPM", name: "front_sidewards", position: None, thruster_direction: [0.0, 1.0, 0.0], rpm_controlled: true }, ThrusterSettings { current_reversed: false, index: 2, model: "DD50_S3_tailcone_RPM", name: "front_right_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }, ThrusterSettings { current_reversed: true, index: 3, model: "DD50_S3_tailcone_RPM", name: "front_left_upwards", position: None, thruster_direction: [0.0, 0.0, 1.0], rpm_controlled: true }] }, camera: CameraSettings { exposure_control_settings_list: [ExposureControl { exposure_target: 0.3, exposure_target_quantile: 0.3, gain_margin: 3.0, gain_target: 5.0, name: "default" }, ExposureControl { exposure_target: 0.4, exposure_target_quantile: 0.95, gain_margin: 3.0, gain_target: 5.0, name: "highlights" }], stereo: false, lights: Some(Lights { temperature_sensors: {"nosecone": [218469099307008, 214543499198464], "tailcone": [144801820246016, 164593029545984]}, overheating_threshold: 50.0 }), use_mocked: true, use_hardware_triggers: true, vertical_fov_degrees: 51.4, live_stitching: None }, communication: CommunicationSettings { discovery_node: DiscoveryNodeSettings { broadcast_ips: [255.255.255.255, 192.168.30.255], broadcast_interfaces: [], broadcast_port: 10899 }, identity: IdentitySettings { name: "simulated_scout", serial_number: None, ip_addresses: [], usbl_id: 3 }, enabled: true, request_server: RequestServer { port: 10820 }, ui_settings_whitelist: ["actuation/max_current_change_per_second", "camera/use_mocked", "communication/world_model_update_frequency_hz", "control/frequency", "active_profile", "path_planner", "robot", "safety/min_cell_voltage", "safety/max_battery_temperature", "safety/min_altitude", "safety/max_altitude", "safety/altitude_safety_fallback_buffer", "safety/altitude_setpoint_buffer", "safety/max_expected_sea_floor_depth", "safety/min_expected_sea_floor_depth", "safety/max_update_dt", "safety/max_thruster_temp", "safety/max_thruster_disconnect_time", "safety/min_dvl_altitude_working", "safety/min_dvl_depth_working", "safety/max_roll_error_degrees", "safety/roll_safety_fallback_buffer_degrees", "safety/roll_safety_fallback_max_duration_seconds", "safety/max_pitch_error_degrees", "safety/max_position_error_meters", "sensors/imu/frequency", "sensors/nortek_dvl/start_measuring_pressure_only", "sensors/nortek_dvl/dvl_settings/led", "sensors/nortek_dvl/dvl_settings/record_199_data", "sensors/nortek_dvl/dvl_settings/measuring_mode", "sensors/nortek_dvl/dvl_settings/sample_rate", "sensors/nortek_dvl/dvl_settings/cp_sample_interval", "sensors/nortek_dvl/dvl_settings/salinity", "sensors/nortek_dvl/dvl_settings/bt_range", "sensors/nortek_dvl/dvl_settings/bt_max_along_beam_velocity", "state_estimation", "task_scheduler"], world_model_update_frequency_hz: 20.0 }, control: ControlSettings { frequency: 100.0, model: ControlModel { d_linear: [[2.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 40.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 40.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 1.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]], d_quadratic: [[55.0, 0.0, 0.0, 0.0, 0.0, 0.0], [0.0, 400.0, 0.0, 0.0, 0.0, 0.0], [0.0, 0.0, 400.0, 0.0, 0.0, 0.0], [0.0, 0.0, 0.0, 4.882, 0.0, 0.0], [0.0, 0.0, 0.0, 0.0, 80.0, 0.0], [0.0, 0.0, 0.0, 0.0, 0.0, 80.0]], damping_x_asym: 0.0, m_a: [[2.27703, 0.0, 0.0, 0.0, -0.00977, -0.0], [0.0, 66.39192, 0.0, 0.07973, 0.0, -0.38227], [0.0, 0.0, 65.93975, 0.0, 0.4623, -0.0], [0.0, 0.07973, 0.0, 0.72, 0.0, 0.01411], [-0.00977, 0.0, 0.4623, 0.0, 19.17022, -0.0], [-0.0, -0.38227, -0.0, 0.01411, -0.0, 19.18307]], modules: Modules { module_configuration: ["scout_3"], modules: {"scout_3": ModuleInformation { center_of_mass: [1.00235121, 0.00123998, 0.00154298], center_of_volume: [0.99326563, -1.34e-6, -0.0], length: 1.91214, mass: 52.44353958, moment_of_inertia: [[0.26065892, 0.00607949, -0.00522948], [0.00607949, 12.7208684, 0.00011234], [-0.00522948, 0.00011234, 12.69270147]], name: "scout_3", poi: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "ps_location": [1.28577, 0.0, 0.06725], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "camera_rear_location": [0.9707, 0.0, 0.0066], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0]}), volume: 0.053 }}, standard_hull_radius: 0.1, volume_error: 0.0 }, pos_co_b: [0.0, 0.0, 0.0], water_density: 997.0 }, pids: Pids { x_angular_velocity: PidParameters { kp: 14.0, ki: 1.0, kd: 0.3, min: -2.0, max: 2.0, cut_off_freq: 10.0 }, x_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.04, min: -1.0, max: 1.0, cut_off_freq: 10.0 }, x_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, x_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 5.0, min: -42.03, max: 46.5, cut_off_freq: 10.0 }, y_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, y_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, y_position: PidParameters { kp: 0.5, ki: 0.0, kd: 0.05, min: -0.5, max: 0.5, cut_off_freq: 10.0 }, y_velocity: PidParameters { kp: 200.0, ki: 30.0, kd: 15.0, min: -50.0, max: 50.0, cut_off_freq: 10.0 }, z_angular_velocity: PidParameters { kp: 90.0, ki: 10.0, kd: 1.5, min: -12.0, max: 12.0, cut_off_freq: 10.0 }, z_attitude: PidParameters { kp: 1.0, ki: 0.0, kd: 0.1, min: -0.4, max: 0.4, cut_off_freq: 10.0 }, z_position: PidParameters { kp: 1.5, ki: 0.0, kd: 0.075, min: -0.25, max: 0.25, cut_off_freq: 10.0 }, z_velocity: PidParameters { kp: 200.0, ki: 15.0, kd: 10.0, min: -40.0, max: 40.0, cut_off_freq: 10.0 } }, forward_roll_cross_coupling_gain: -0.02 }, path_planner: PathPlannerSettings { control_attitude_tolerance_degrees: 6.0, control_goal_timeout_seconds: 15, control_position_tolerance_meters: 0.1, control_request_timeout_millis: 100, desired_update_frequency: 40.0, fallback_survey_orientation_degrees: 0.0, max_time_to_wait_for_new_goal_seconds: 0.5, polygon_scaling_factor: 1.02, vertical_position_constraints: VerticalPositionConstraints { min_preferred_altitude: 3.0, min_preferred_depth: 5.0, min_required_altitude: 1.0, min_required_depth: 0.0, velocity_at_min_required_altitude: 0.5, velocity_at_min_required_depth: 0.9, velocity_in_preferred_range: 1.0, velocity_limit_depth: 10.0 }, strategy_planner_parameters: StrategyPlannerParameters { heading_deviation_threshold_degrees: 6.0, position_threshold_xy: 0.7, setpoint_radius_xy: 0.6, line_end_threshold: 0.1, low_velocity_threshold: 0.1, max_line_deviation_xy: 0.15, max_pitch_slope_degrees: 30.0, static_surface_depth: 0.1, motion_planner_parameters: MotionPlannerParameters { max_acceleration: [0.5, 0.1, 0.3], max_angular_acceleration: [0.5, 0.5, 0.5], max_angular_velocity: [0.5, 0.3, 0.3], max_deceleration: [0.4, 0.3, 0.3], max_velocity: [1.2, 0.2, 0.2] }, orientation_distance_threshold: 0.2, position_on_track_hysteresis: 0.1, timeout_delay_seconds: 60.0, timeout_delay_factor: 2.5, estimate_delay_seconds: 30.0, estimate_delay_factor: 1.5, position_threshold_z: 0.1 } }, robot: RobotSettings { logging_name: "simulated_scout", can_enabled: false, enable_thrusters: true }, safety: SafetySettings { altitude_safety_fallback_buffer: 0.1, altitude_setpoint_buffer: 0.1, max_altitude: 50.0, max_battery_temperature: 40.0, max_depth: 40.2, max_expected_sea_floor_depth: 45.0, max_pitch_error_degrees: 45.0, max_position_error_meters: 20.0, max_roll_error_degrees: 45.0, max_thruster_disconnect_time: 5.0, max_thruster_temp: 70.0, max_update_dt: 0.5, min_altitude: 0.3, min_cell_voltage: 3.4, min_dvl_altitude_working: 20.0, min_dvl_depth_working: 5.0, min_expected_sea_floor_depth: 0.0, roll_safety_fallback_buffer_degrees: 15.0, roll_safety_fallback_max_duration_seconds: 5.0 }, sensors: SensorSettings { gps: Gps { enabled: false }, imu: Imu { acc_a: [0.998631, 0.0, 0.0, 0.0, 0.998631, 0.0, 0.0, 0.0, 0.998631], acc_b: [0.0, 0.0, 0.0], enabled: false, filter_low_pass_3_db_frequency: 20.0, frequency: 250.0, gyro_b: [-0.000357, 0.000623, 0.001831], name: Adis164753, orientation: [0.0, 1.0, 0.0, 0.0, 0.0, 1.0, 1.0, 0.0, 0.0] }, magnetometer: Magnetometer { enabled: false, mag_a: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0], mag_b: [0.0, 1.0, 0.0], orientation: [1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, -1.0, 0.0] }, nortek_dvl: NortekDvl { command_port_timeout_millis: 2000, data_port_timeout_millis: 500, dvl_settings: DvlSettings { bt_blanking_distance: 0.06, bt_max_along_beam_velocity: 5.0, bt_range: 50.0, bt_settings_raw: "NB=4,CH=0,DF=21,PL=0.0,WTDF=22,PLMODE=\"MAX\"", cp_blanking_distance: 1.0, cp_cell_size: 1.0, cp_number_of_cells: 30, cp_sample_interval: 10, cp_settings_raw: "CY=\"XYZ\",PL=0.0,VP=0.000,VR=2.50,DF=3,NB=4,CH=0", do_fast_pressure: true, do_water_track: false, dvl_settings_raw: "TRIG=\"INTSR\",FN=\"\",SV=0,ALTI=0,FASTTRIG=1", fast_pressure_sample_rate: 30, fast_pressure_settings_raw: "DF=41", initial_pressure_offset: 9.51, instrument_yaw: 0.0, led: false, measuring_mode: Auto, record_199_data: false, salinity: 35.0, sample_rate: 8.0 }, enabled: false, host: "192.168.30.102", id: 106006, start_measuring_pressure_only: false }, sonar: Sonar { enabled: true, tilt_degree: 15.0 }, usbl: None }, active_profile: Default, simulator: Some(SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }), state_estimation: StateEstimationSettings { depth_samples_max_timeout_millis: 10000, external_disturbance_heading_valid_time_minutes: 60.0, gnss_samples_use_one_in_n: 8, seafloor_depth_smoothing_factor: 0.7, magnetic_field_strength_deviation: 4.0 }, task_scheduler: TaskSchedulerSettings { preparing_behavior: PreparationModeBehavior { max_number_gps_tasks: 2, max_number_move_to_start_tasks: 2 }, desired_update_frequency: 50.0, excessive_current_handling: ExcessiveCurrentParams { lateral_disturbance_threshold: 0.9, lateral_velocity_threshold: 0.07, time_threshold: 10.0, trigger_check_period_seconds: 0.1, trigger_count_limit_per_survey: 5, max_time_to_disable_preparation_tasks_minutes: 10.0 }, task_settings: TaskSettings { max_horizontal_distance_to_start_meters: 300.0, buoyancy_calibration: BuoyancyCalibrationSettings { calibration_depth: 1.0, minimum_required_seafloor_depth: 2.0, pitch_step_degrees: 20.0, roll_step_degrees: 20.0, step_duration_seconds: 20.0, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, external_disturbance_estimation: ExternalDisturbanceEstimationSettings { acceptable_normalized_lateral_disturbance: 0.4, lateral_disturbance_optimization_threshold: 0.05, longitudinal_disturbance_direction_threshold: 0.1, min_binary_search_step_size_degrees: 3.0, minimum_task_depth_meters: 1.0, wait_between_steps_seconds: 30.0 }, get_gps: GetGpsSettings { max_duration_seconds: 300.0, step_duration_seconds: 2.0, minimum_uncertainty_meters: 1.0, ascend_position_control_disable_depth: 1.5 }, hold: HoldSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, magnetometer_calibration: MagnetometerCalibrationSettings { calibration_depth: 1.5, minimum_required_seafloor_depth: 3.0, pitch_steps: 5, roll_steps: 4, calibration_step_duration_seconds: 1.0, calibration_timeout_seconds: 10.0 }, manual_control: ManualControlSettings { default_force: 20.0, max_angular_velocity: 0.2, max_depth: 1.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.05, initial_pitch_setpoint_deg: 5.0, control_yaw_error: false }, move_to: MoveToSettings { max_horizontal_distance_to_start_meters: None, minimum_required_seafloor_depth: 1.0, preferred_velocity_meter_per_second: 1.0 }, survey_area: SurveySettings { max_horizontal_distance_to_start_meters: None, default_velocity_meter_per_second: 0.4, maximum_velocity_meter_per_second: 1.5, min_current_magnitude_meter_per_second: 0.1, polygon_safety_scaling_factor: 1.02, max_initial_position_uncertainty_meters: 3.0 }, visibility_check: VisibilityCheckSettings { default_start_altitude: 3.0, default_end_altitude: 0.5, diving_velocity: 0.2, photo_interval: 0.1 } }, waiting_hold_duration_seconds: 300.0 } }
17:59:31.898 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "ps_location": [1.28577, 0.0, 0.06725], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "camera_rear_location": [0.9707, 0.0, 0.0066], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0]})
17:59:31.898 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:31.900 INFO  [robot_code/utilities/simulator/src/simulator.rs:89] Initializing simulator with timestep: 20ms and simulator settings: SimulatorSettings { bottom: Flat, enable_user_debug_parameters: false, gui: true, multi_beam: MultiBeam { fov: 120.0, n_beams: 50, pos: [0.9, 0.0, 0.0], range: 15.0, tilt: 20.0, visualize_beams: true }, origin_latitude: 52.048187, origin_longitude: 4.369903, realtime: true, scout_model: Scout3, sea_floor_depth: 10.0, start_attitude_euler_degrees: [0.0, 0.0, 0.0], start_position: [0.0, 0.0, 1.0], steps_per_second: 50, water_current: [0.0, 0.0, 0.0], sensor_noises: SensorNoises { noise_scaling_factor: 1.0, std_accelerometer: 0.02, std_gyroscope: 0.002, std_magnetometer: 2.0, std_dvl_velocity: 0.01, std_dvl_beam_distance: 0.1, std_gnss_receiver: 0.5, std_depth: 0.02 } }
17:59:32.039 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "ps_location": [1.28577, 0.0, 0.06725], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "camera_rear_location": [0.9707, 0.0, 0.0066], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0]})
17:59:32.039 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:56.883 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "ps_location": [1.28577, 0.0, 0.06725], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "camera_rear_location": [0.9707, 0.0, 0.0066], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0]})
17:59:56.883 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:56.883 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
17:59:56.883 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
17:59:56.884 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
17:59:56.884 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
17:59:56.884 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
17:59:56.884 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
17:59:56.884 WARN  [robot_code/robot_core/launch/src/lib.rs:570] IMU not enabled
17:59:56.884 WARN  [robot_code/robot_core/launch/src/lib.rs:588] Magnetometer not enabled
17:59:56.884 WARN  [robot_code/robot_core/launch/src/lib.rs:176] Magnetometer not enabled, state estimation will not be able to use it
17:59:56.884 WARN  [robot_code/robot_core/launch/src/lib.rs:627] Nortek DVL not enabled
17:59:56.884 WARN  [robot_code/robot_core/launch/src/lib.rs:606] GPS not enabled
17:59:56.884 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
17:59:56.884 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
17:59:56.884 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_range_image
17:59:56.888 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_intensity_image
17:59:56.890 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulated_sonar
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'simulated_sonar' with StopRunningFlag { name: "simulated_sonar", id: 0, stop_running: false, do_auto_stop: true }
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulated_sonar' successfully started
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulated_sonar with pid: 59439
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
17:59:56.890 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
17:59:56.891 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
17:59:56.891 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
17:59:56.891 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
17:59:56.891 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
17:59:56.891 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
17:59:56.891 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
17:59:56.892 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
17:59:56.893 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"usbl_modem_location": [1.3235, 0.0, -0.09595], "magnetometer_location": [1.06914, 0.00188, -0.20086], "imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "ps_location": [1.28577, 0.0, 0.06725], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "gps_location": [0.93573, 0.00255, -0.17048], "sonar_location": [1.81926, 0.0, 0.00717], "camera_rear_location": [0.9707, 0.0, 0.0066], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0]})
17:59:56.893 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:109] RobotModel calculated. Info: - total mass: 52.444 kg, total length: 1.912 m, dvl location: Some([[0.32814878999999997, -0.00123998, 0.01605702]]) volume: 0.053
17:59:56.893 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'control' with StopRunningFlag { name: "control", id: 0, stop_running: false, do_auto_stop: true }
17:59:56.893 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
17:59:56.894 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
17:59:56.894 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 59467
17:59:56.894 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
17:59:56.894 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
17:59:56.894 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
17:59:56.895 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
17:59:56.904 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
17:59:56.904 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'simulator' with StopRunningFlag { name: "simulator", id: 0, stop_running: false, do_auto_stop: true }
17:59:56.904 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
17:59:56.904 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 59471
17:59:56.934 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
17:59:56.975 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
17:59:56.975 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
17:59:56.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'path_planner' with StopRunningFlag { name: "path_planner", id: 0, stop_running: false, do_auto_stop: true }
17:59:56.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
17:59:56.975 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
17:59:56.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
17:59:56.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 59473
17:59:56.975 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
17:59:56.976 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
17:59:56.976 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'task_scheduler' with StopRunningFlag { name: "task_scheduler", id: 0, stop_running: false, do_auto_stop: true }
17:59:56.976 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
17:59:56.976 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 59476
17:59:56.976 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
17:59:56.976 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
17:59:56.977 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for lora_module
17:59:56.977 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'lora_module' with StopRunningFlag { name: "lora_module", id: 0, stop_running: false, do_auto_stop: true }
17:59:56.977 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'lora_module' successfully started
17:59:56.977 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread lora_module with pid: 59527
17:59:56.977 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for outgoing_message
17:59:57.015 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
17:59:57.015 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
17:59:57.015 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:59:57.019 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"sensors": Object {"magnetometer": Object {"magA": Array [Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0), Number(0.0), Number(0.0), Number(0.0), Number(1.0)], "magB": Array [Number(0.0), Number(1.0), Number(0.0)]}}}
17:59:57.019 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'device_settings'. Description: Dynamic device specific settings. During runtime, these settings can be changed either by the user or by the robot itself.
17:59:57.020 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
17:59:57.020 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
17:59:57.022 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {"camera": Object {"live_stitching": Null, "use_mocked": Bool(true)}, "communication": Object {"enabled": Bool(false), "identity": Object {"name": String("simulated_scout")}}, "robot": Object {"can_enabled": Bool(false), "logging_name": String("simulated_scout")}, "sensors": Object {"gps": Object {"enabled": Bool(false)}, "imu": Object {"enabled": Bool(false)}, "magnetometer": Object {"enabled": Bool(false)}, "nortek_dvl": Object {"enabled": Bool(false)}, "sonar": Object {"enabled": Bool(true), "tilt_degree": Number(15.0)}, "usbl": Null}, "simulator": Object {"bottom": String("flat"), "enable_user_debug_parameters": Bool(false), "gui": Bool(false), "multi_beam": Object {"fov": Number(120), "n_beams": Number(50), "pos": Array [Number(0.9), Number(0.0), Number(0.0)], "range": Number(15.0), "tilt": Number(20.0), "visualize_beams": Bool(true)}, "origin_latitude": Number(52.048187), "origin_longitude": Number(4.369903), "realtime": Bool(false), "scout_model": String("scout3"), "sea_floor_depth": Number(10.0), "sensor_noises": Object {"noise_scaling_factor": Number(1.0), "std_accelerometer": Number(0.02), "std_depth": Number(0.02), "std_dvl_beam_distance": Number(0.1), "std_dvl_velocity": Number(0.01), "std_gnss_receiver": Number(0.5), "std_gyroscope": Number(0.002), "std_magnetometer": Number(2.0)}, "start_attitude_euler_degrees": Array [Number(0.0), Number(0.0), Number(0.0)], "start_position": Array [Number(0), Number(0), Number(1)], "steps_per_second": Number(50), "water_current": Array [Number(0.0), Number(0.0), Number(0.0)]}}
17:59:57.022 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
17:59:57.023 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
17:59:57.023 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'communication' with StopRunningFlag { name: "communication", id: 0, stop_running: false, do_auto_stop: true }
17:59:57.024 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
17:59:57.024 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 59529
17:59:57.024 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
17:59:57.024 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
17:59:57.024 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:81] grpc listening on 0.0.0.0:10820
17:59:57.024 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
17:59:57.024 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
17:59:57.024 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Waiting until code stops running so threads can be joined
17:59:57.024 INFO  [robot_code/robot_core/launch/src/lib.rs:553] Trying to join thread 'simulated_sonar'
17:59:57.035 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
17:59:57.035 INFO  [robot_code/peripherals/communication/src/grpc_handlers/sonar_handler.rs:48] Creating sonar service
17:59:57.035 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_service
17:59:57.036 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:108] StopRunningFlag { name: "request_handling_toolbox", id: 0, stop_running: false, do_auto_stop: false } got dropped, but auto stop is disabled.
17:59:57.036 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'discovery_node' with StopRunningFlag { name: "discovery_node", id: 0, stop_running: false, do_auto_stop: false }
17:59:57.036 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
17:59:57.036 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 59532
17:59:57.036 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:155] Started watching interfaces
17:59:57.036 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:100] Sending heartbeat simulated_scout:318451712@[] to: ["255.255.255.255:10899", "192.168.30.255:10899"]
17:59:57.038 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for core_telemetry_stream
17:59:57.039 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for periodic_telemetry_stream
17:59:57.938 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.31Hz
17:59:58.942 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
17:59:59.945 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:00.949 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:01.953 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:02.956 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:03.961 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.77Hz
18:00:04.965 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:05.969 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.78Hz
18:00:06.973 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:07.976 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:08.980 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:09.983 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:10.987 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
18:00:11.990 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:12.993 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:13.997 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:15.001 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:16.004 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:17.008 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:00:18.015 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.67Hz
18:00:19.018 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:20.022 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:21.027 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.77Hz
18:00:22.030 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:23.034 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
18:00:24.037 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
18:00:25.041 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:26.045 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:27.048 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:28.052 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:29.055 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:30.058 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:31.062 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:32.065 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:33.069 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:34.072 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:35.076 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:36.079 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:37.083 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:38.087 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:00:39.091 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:40.097 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.70Hz
18:00:41.102 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.76Hz
18:00:42.105 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:43.111 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.72Hz
18:00:44.117 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.70Hz
18:00:45.121 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:46.124 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:47.129 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.78Hz
18:00:48.133 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:00:49.136 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:50.140 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:51.145 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.77Hz
18:00:52.150 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.74Hz
18:00:53.154 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
18:00:54.158 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.78Hz
18:00:55.164 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.71Hz
18:00:56.167 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
18:00:57.171 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:00:58.175 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:00:59.178 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:00.182 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:01.185 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:02.189 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:03.192 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:04.195 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:05.199 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:06.203 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:07.207 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.76Hz
18:01:08.211 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:09.217 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.71Hz
18:01:10.221 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:01:11.225 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:12.233 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.59Hz
18:01:13.240 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.66Hz
18:01:14.245 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.73Hz
18:01:15.254 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.55Hz
18:01:16.258 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
18:01:17.262 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
18:01:18.265 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
18:01:19.269 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:20.272 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:21.276 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:22.279 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
18:01:23.283 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:24.286 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:25.290 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:26.293 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:27.297 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:28.300 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:29.304 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:30.307 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:31.312 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.75Hz
18:01:32.316 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:33.319 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:01:34.327 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.61Hz
18:01:35.332 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:01:36.336 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.77Hz
18:01:37.342 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.73Hz
18:01:38.350 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.59Hz
18:01:39.354 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.77Hz
18:01:40.359 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.78Hz
18:01:41.362 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:42.367 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.77Hz
18:01:43.378 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.48Hz
18:01:44.387 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.52Hz
18:01:45.394 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.65Hz
18:01:46.398 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:47.402 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
18:01:48.406 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:49.409 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:50.413 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:01:51.416 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
18:01:52.419 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:53.423 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:54.427 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:55.431 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:01:56.435 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:01:57.438 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:58.442 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:01:59.449 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.68Hz
18:02:00.452 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
18:02:01.456 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:02:02.459 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:02:03.463 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:02:04.467 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
18:02:05.470 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:02:06.473 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
18:02:07.480 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.68Hz
18:02:08.485 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.76Hz
18:02:09.489 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.78Hz
18:02:10.495 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.70Hz
18:02:11.499 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:02:12.503 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
18:02:13.507 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz