08:58:24.436 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
08:58:24.436 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-04 08:58:24.436977260 +01:00
08:58:24.436 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
08:58:24.436 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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
08:58:24.437 INFO  [robot_code/utilities/logging/src/logger_manager.rs:93] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-04_simulated_scout/2025-11-04_08-58-24_simulated_scout.lobsterlog")
08:58:24.438 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
08:58:24.439 INFO  [robot_code/robot_core/launch/src/lib.rs:135] 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] }, "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_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] }, "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] }}, 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" }], lights: Some(Lights { downstream_overheating_threshold: 60.0, temperature_pairs: {"tailcone": TemperaturePair { downstream_id: 164593029545984, upstream_id: 144801820246016 }, "nosecone": TemperaturePair { downstream_id: 214543499198464, upstream_id: 218469099307008 }}, upstream_overheating_threshold: 40.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, name: "simulated_scout", serial_number: None, additional_ips: [] }, lora: LoraSettings { lora_id: 30000, lora_discovery: LoraDiscovery { name: "scout3-X (Example)", ip_addresses: ["100.68.112.107"], 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({"imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "magnetometer_location": [1.06914, 0.00188, -0.20086], "sonar_location": [1.81926, 0.0, 0.00717], "camera_front_location": [1.1187, 0.0, 0.0066], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "ps_location": [1.28577, 0.0, 0.06725]}), 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: Some(SerialPortConfiguration { baud_rate: 115200, port_timeout_millis: 1000, serial_port: "/dev/ttyS0" }) }, 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: 20.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.5, 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 } }
08:58:24.508 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "magnetometer_location": [1.06914, 0.00188, -0.20086], "sonar_location": [1.81926, 0.0, 0.00717], "camera_front_location": [1.1187, 0.0, 0.0066], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "ps_location": [1.28577, 0.0, 0.06725]})
08:58:24.508 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
08:58:24.509 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 } }
08:58:24.637 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "magnetometer_location": [1.06914, 0.00188, -0.20086], "sonar_location": [1.81926, 0.0, 0.00717], "camera_front_location": [1.1187, 0.0, 0.0066], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "ps_location": [1.28577, 0.0, 0.06725]})
08:58:24.637 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
08:58:53.692 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "magnetometer_location": [1.06914, 0.00188, -0.20086], "sonar_location": [1.81926, 0.0, 0.00717], "camera_front_location": [1.1187, 0.0, 0.0066], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "ps_location": [1.28577, 0.0, 0.06725]})
08:58:53.692 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
08:58:53.692 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
08:58:53.692 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
08:58:53.692 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
08:58:53.693 WARN  [robot_code/robot_core/launch/src/lib.rs:560] IMU not enabled
08:58:53.693 WARN  [robot_code/robot_core/launch/src/lib.rs:578] Magnetometer not enabled
08:58:53.693 WARN  [robot_code/robot_core/launch/src/lib.rs:181] Magnetometer not enabled, state estimation will not be able to use it
08:58:53.693 WARN  [robot_code/robot_core/launch/src/lib.rs:617] Nortek DVL not enabled
08:58:53.693 WARN  [robot_code/robot_core/launch/src/lib.rs:596] GPS not enabled
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
08:58:53.693 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
08:58:53.693 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
08:58:53.694 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
08:58:53.695 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
08:58:53.696 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"imu_location": [1.22915, -0.07144, -0.03025], "gps_2_location": [1.05957, -0.00255, -0.20834], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "dvl_location": [1.3305, 0.0, 0.0176], "magnetometer_location": [1.06914, 0.00188, -0.20086], "sonar_location": [1.81926, 0.0, 0.00717], "camera_front_location": [1.1187, 0.0, 0.0066], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "camera_rear_location": [0.9707, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "gps_location": [0.93573, 0.00255, -0.17048], "usbl_modem_location": [1.3235, 0.0, -0.09595], "ps_location": [1.28577, 0.0, 0.06725]})
08:58:53.696 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
08:58:53.696 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
08:58:53.696 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 }
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 28348
08:58:53.696 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
08:58:53.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_range_image
08:58:53.696 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
08:58:53.700 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_intensity_image
08:58:53.701 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulated_sonar
08:58:53.701 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 }
08:58:53.701 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulated_sonar' successfully started
08:58:53.701 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulated_sonar with pid: 28351
08:58:53.701 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_manager
08:58:53.701 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'sonar_manager' with StopRunningFlag { name: "sonar_manager", id: 0, stop_running: false, do_auto_stop: true }
08:58:53.701 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'sonar_manager' successfully started
08:58:53.701 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
08:58:53.701 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread sonar_manager with pid: 28352
08:58:53.702 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
08:58:53.703 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
08:58:53.706 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
08:58:53.707 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 }
08:58:53.707 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
08:58:53.707 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 28356
08:58:53.737 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
08:58:53.773 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
08:58:53.773 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
08:58:53.773 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 }
08:58:53.773 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
08:58:53.773 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
08:58:53.773 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_payload
08:58:53.773 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
08:58:53.773 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 28358
08:58:53.793 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
08:58:53.794 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
08:58:53.794 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 }
08:58:53.794 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
08:58:53.794 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 28361
08:58:53.794 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
08:58:53.794 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
08:58:53.834 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
08:58:53.834 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
08:58:53.834 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
08:58:53.835 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)]}}}
08:58:53.835 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.
08:58:53.837 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
08:58:53.837 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
08:58:53.838 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 {"discovery_node": Object {"name": String("simulated_scout")}, "enabled": Bool(false)}, "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)}}, "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)]}}
08:58:53.838 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
08:58:53.840 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
08:58:53.840 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 }
08:58:53.840 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
08:58:53.840 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 28372
08:58:53.840 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
08:58:53.840 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
08:58:53.840 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:79] grpc listening on 0.0.0.0:10820
08:58:53.840 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
08:58:53.840 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
08:58:53.840 INFO  [robot_code/robot_core/launch/src/lib.rs:533] Waiting until code stops running so threads can be joined
08:58:53.840 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Trying to join thread 'control'
08:58:53.854 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
08:58:53.854 INFO  [robot_code/peripherals/communication/src/grpc_handlers/sonar_service.rs:54] Creating sonar service
08:58:53.854 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_service
08:58:53.854 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.
08:58:53.854 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 }
08:58:53.854 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
08:58:53.854 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 28375
08:58:53.854 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:66] Created new persistent discovery node ID: 318451712
08:58:53.855 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:146] Started watching interfaces
08:58:53.855 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:91] Sending heartbeat simulated_scout:318451712@[] to: ["255.255.255.255:10899", "192.168.30.255:10899"]
08:58:54.736 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.55Hz
08:58:55.739 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:58:56.742 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:58:57.745 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:58:58.748 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:58:59.751 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:00.756 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.75Hz
08:59:01.760 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
08:59:02.766 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.73Hz
08:59:03.774 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.59Hz
08:59:04.777 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:05.780 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:06.783 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:07.785 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.87Hz
08:59:08.788 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:09.791 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:10.794 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:11.797 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:12.800 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:13.803 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:14.806 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:15.809 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:16.812 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:17.816 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.78Hz
08:59:18.819 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:19.822 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:20.825 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:21.828 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:22.833 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.74Hz
08:59:23.836 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:24.839 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
08:59:25.842 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:26.845 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:27.848 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:28.851 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:29.854 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:30.857 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
08:59:31.861 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
08:59:32.864 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:33.866 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
08:59:34.870 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:35.872 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.87Hz
08:59:36.876 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:37.879 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
08:59:38.882 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:39.885 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:40.888 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:41.892 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:42.895 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
08:59:43.898 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:44.901 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:45.905 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
08:59:46.908 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
08:59:47.911 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:48.915 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
08:59:49.918 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
08:59:50.921 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:51.924 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
08:59:52.052 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}}

09:00:08.055 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
09:00:08.055 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-04 09:00:08.055605807 +01:00
09:00:08.055 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
09:00:08.055 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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
09:00:08.055 INFO  [robot_code/utilities/logging/src/logger_manager.rs:93] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-04_simulated_scout/2025-11-04_09-00-08_simulated_scout.lobsterlog")
09:00:08.061 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
09:00:08.062 INFO  [robot_code/robot_core/launch/src/lib.rs:135] 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] }, "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] }, "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" }], lights: Some(Lights { downstream_overheating_threshold: 60.0, temperature_pairs: {"tailcone": TemperaturePair { downstream_id: 164593029545984, upstream_id: 144801820246016 }, "nosecone": TemperaturePair { downstream_id: 214543499198464, upstream_id: 218469099307008 }}, upstream_overheating_threshold: 40.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, name: "simulated_scout", serial_number: None, additional_ips: [] }, lora: LoraSettings { lora_id: 30000, lora_discovery: LoraDiscovery { name: "scout3-X (Example)", ip_addresses: ["100.68.112.107"], 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({"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], "magnetometer_location": [1.06914, 0.00188, -0.20086], "usbl_modem_location": [1.3235, 0.0, -0.09595], "dvl_location": [1.3305, 0.0, 0.0176], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "imu_location": [1.22915, -0.07144, -0.03025], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "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: true, tilt_degree: 15.0 }, usbl: Some(SerialPortConfiguration { baud_rate: 115200, port_timeout_millis: 1000, serial_port: "/dev/ttyS0" }) }, 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: 20.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.5, 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 } }
09:00:08.141 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"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], "magnetometer_location": [1.06914, 0.00188, -0.20086], "usbl_modem_location": [1.3235, 0.0, -0.09595], "dvl_location": [1.3305, 0.0, 0.0176], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "imu_location": [1.22915, -0.07144, -0.03025], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066]})
09:00:08.141 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
09:00:08.142 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 } }
09:00:08.260 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"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], "magnetometer_location": [1.06914, 0.00188, -0.20086], "usbl_modem_location": [1.3235, 0.0, -0.09595], "dvl_location": [1.3305, 0.0, 0.0176], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "imu_location": [1.22915, -0.07144, -0.03025], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066]})
09:00:08.260 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
09:00:50.651 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"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], "magnetometer_location": [1.06914, 0.00188, -0.20086], "usbl_modem_location": [1.3235, 0.0, -0.09595], "dvl_location": [1.3305, 0.0, 0.0176], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "imu_location": [1.22915, -0.07144, -0.03025], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066]})
09:00:50.651 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
09:00:50.651 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
09:00:50.652 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
09:00:50.652 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
09:00:50.653 WARN  [robot_code/robot_core/launch/src/lib.rs:560] IMU not enabled
09:00:50.653 WARN  [robot_code/robot_core/launch/src/lib.rs:578] Magnetometer not enabled
09:00:50.653 WARN  [robot_code/robot_core/launch/src/lib.rs:181] Magnetometer not enabled, state estimation will not be able to use it
09:00:50.653 WARN  [robot_code/robot_core/launch/src/lib.rs:617] Nortek DVL not enabled
09:00:50.653 WARN  [robot_code/robot_core/launch/src/lib.rs:596] GPS not enabled
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
09:00:50.653 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
09:00:50.653 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
09:00:50.654 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
09:00:50.655 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
09:00:50.656 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
09:00:50.656 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
09:00:50.656 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
09:00:50.656 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"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], "magnetometer_location": [1.06914, 0.00188, -0.20086], "usbl_modem_location": [1.3235, 0.0, -0.09595], "dvl_location": [1.3305, 0.0, 0.0176], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "imu_location": [1.22915, -0.07144, -0.03025], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "gps_2_location": [1.05957, -0.00255, -0.20834], "rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066]})
09:00:50.656 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
09:00:50.656 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
09:00:50.656 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 }
09:00:50.656 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
09:00:50.656 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 32122
09:00:50.656 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
09:00:50.656 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
09:00:50.656 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_range_image
09:00:50.659 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_intensity_image
09:00:50.661 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulated_sonar
09:00:50.661 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 }
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulated_sonar' successfully started
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulated_sonar with pid: 32125
09:00:50.661 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_manager
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'sonar_manager' with StopRunningFlag { name: "sonar_manager", id: 0, stop_running: false, do_auto_stop: true }
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'sonar_manager' successfully started
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread sonar_manager with pid: 32126
09:00:50.661 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
09:00:50.662 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
09:00:50.666 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
09:00:50.666 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 }
09:00:50.666 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
09:00:50.666 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 32130
09:00:50.696 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
09:00:50.732 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
09:00:50.732 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
09:00:50.732 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 }
09:00:50.733 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
09:00:50.733 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
09:00:50.733 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_payload
09:00:50.733 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
09:00:50.733 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 32132
09:00:50.753 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
09:00:50.753 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
09:00:50.753 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 }
09:00:50.753 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
09:00:50.753 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 32135
09:00:50.753 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
09:00:50.753 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
09:00:50.793 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
09:00:50.793 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
09:00:50.793 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
09:00:50.796 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)]}}}
09:00:50.796 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.
09:00:50.798 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
09:00:50.798 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
09:00:50.799 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 {"discovery_node": Object {"name": String("simulated_scout")}, "enabled": Bool(false)}, "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)}}, "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)]}}
09:00:50.799 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
09:00:50.801 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
09:00:50.801 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 }
09:00:50.801 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
09:00:50.801 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 32145
09:00:50.801 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
09:00:50.801 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
09:00:50.801 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:79] grpc listening on 0.0.0.0:10820
09:00:50.802 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
09:00:50.802 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
09:00:50.802 INFO  [robot_code/robot_core/launch/src/lib.rs:533] Waiting until code stops running so threads can be joined
09:00:50.802 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Trying to join thread 'control'
09:00:50.813 INFO  [robot_code/peripherals/communication/src/grpc_handlers/sonar_service.rs:54] Creating sonar service
09:00:50.813 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_service
09:00:50.813 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
09:00:50.813 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.
09:00:50.813 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 }
09:00:50.813 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
09:00:50.813 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 32148
09:00:50.814 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:146] Started watching interfaces
09:00:50.814 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:91] Sending heartbeat simulated_scout:318451712@[] to: ["255.255.255.255:10899", "192.168.30.255:10899"]
09:00:51.696 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.55Hz
09:00:52.698 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:00:53.702 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:00:54.704 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:00:55.708 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:00:56.711 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:00:57.714 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:00:58.717 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:00:59.720 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:01:00.723 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:01.726 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:02.729 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:03.732 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:04.735 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:05.738 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:01:06.741 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:07.744 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:08.747 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:09.750 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:10.753 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:01:11.756 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:12.760 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.81Hz
09:01:13.763 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:14.766 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:15.769 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:16.772 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:17.775 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:01:18.778 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:19.781 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:20.784 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:21.787 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:22.791 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.80Hz
09:01:23.794 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:01:24.797 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:25.800 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.82Hz
09:01:26.803 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
09:01:27.806 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:28.809 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:29.812 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:30.815 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:31.818 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:01:32.821 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:01:33.824 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:01:58.218 INFO  [robot_code/utilities/logging/src/logging.rs:92] ================================================================================
09:01:58.218 INFO  [robot_code/utilities/logging/src/logging.rs:93] Starting new Rust log session at 2025-11-04 09:01:58.218962068 +01:00
09:01:58.218 INFO  [robot_code/utilities/logging/src/logging.rs:94] ================================================================================
09:01:58.218 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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_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-04_simulated_scout/2025-11-04_simulated_scout_rust.trace.log.{}", compression: None, base: 0, count: 50 } } }, filters: [ThresholdFilter { level: Trace }] }] }) }
09:01:58.219 INFO  [robot_code/utilities/logging/src/logger_manager.rs:93] Creating logger manager with database path: Some("/home/joris/Desktop/data_root/task_data/2025-11-04_simulated_scout/2025-11-04_09-01-58_simulated_scout.lobsterlog")
09:01:58.224 DEBUG [robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: logging/high_frequency
09:01:58.225 INFO  [robot_code/robot_core/launch/src/lib.rs:135] Launching robot code with following settings:
Settings { actuation: ActuationSettings { max_current_change_per_second: 200.0, thruster_models: {"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] }, "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] }, "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] }}, 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" }], lights: Some(Lights { downstream_overheating_threshold: 60.0, temperature_pairs: {"nosecone": TemperaturePair { downstream_id: 214543499198464, upstream_id: 218469099307008 }, "tailcone": TemperaturePair { downstream_id: 164593029545984, upstream_id: 144801820246016 }}, upstream_overheating_threshold: 40.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, name: "simulated_scout", serial_number: None, additional_ips: [] }, lora: LoraSettings { lora_id: 30000, lora_discovery: LoraDiscovery { name: "scout3-X (Example)", ip_addresses: ["100.68.112.107"], 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({"rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "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], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "imu_location": [1.22915, -0.07144, -0.03025], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "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: true, tilt_degree: 15.0 }, usbl: Some(SerialPortConfiguration { baud_rate: 115200, port_timeout_millis: 1000, serial_port: "/dev/ttyS0" }) }, 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: 20.0, max_force: 60.0, max_pitch_deg: 20.0, max_roll_deg: 20.0, max_dive_velocity: 0.1, min_altitude: 0.5, 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 } }
09:01:58.294 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "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], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "imu_location": [1.22915, -0.07144, -0.03025], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]})
09:01:58.294 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
09:01:58.295 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 } }
09:01:58.405 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "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], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "imu_location": [1.22915, -0.07144, -0.03025], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]})
09:01:58.405 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
09:02:40.905 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "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], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "imu_location": [1.22915, -0.07144, -0.03025], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]})
09:02:40.905 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
09:02:40.905 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: code_launch
09:02:40.906 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: imu
09:02:40.906 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_bottom_track
09:02:40.906 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_water_track
09:02:40.906 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_current_profile
09:02:40.906 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: dvl_depth
09:02:40.907 WARN  [robot_code/robot_core/launch/src/lib.rs:560] IMU not enabled
09:02:40.907 WARN  [robot_code/robot_core/launch/src/lib.rs:578] Magnetometer not enabled
09:02:40.907 WARN  [robot_code/robot_core/launch/src/lib.rs:181] Magnetometer not enabled, state estimation will not be able to use it
09:02:40.907 WARN  [robot_code/robot_core/launch/src/lib.rs:617] Nortek DVL not enabled
09:02:40.907 WARN  [robot_code/robot_core/launch/src/lib.rs:596] GPS not enabled
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: thruster_manager
09:02:40.907 DEBUG [robot_code/peripherals/actuation/src/lib.rs:186] Started simulated thruster module
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/internal_states
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/cascaded_control
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position_settings
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_position
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position_settings
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_position
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position_settings
09:02:40.907 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_position
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude_settings
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_attitude
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude_settings
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_attitude
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude_settings
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_attitude
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity_settings
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_velocity
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity_settings
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_velocity
09:02:40.908 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity_settings
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_velocity
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity_settings
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/x_angular_velocity
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity_settings
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/y_angular_velocity
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity_settings
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: control/pid/z_angular_velocity
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: virtual_normalized_integral_sensor
09:02:40.909 DEBUG [robot_code/utilities/common/src/modeling/robot_model.rs:53] Adding module 0, scout_3 to robot model with POI: Some({"rear_sidewards_thruster_location": [0.189, 0.0, 0.0], "camera_front_location": [1.1187, 0.0, 0.0066], "front_left_upwards_thruster_location": [1.574, -0.053, 0.0], "main_forwards_thruster_location": [0.0, 0.0, 0.0], "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], "usbl_modem_location": [1.3235, 0.0, -0.09595], "front_sidewards_thruster_location": [1.658, 0.0, -0.00825], "imu_location": [1.22915, -0.07144, -0.03025], "front_right_upwards_thruster_location": [1.574, 0.053, 0.0], "dvl_location": [1.3305, 0.0, 0.0176], "rear_left_upwards_thruster_location": [0.273, -0.053, 0.0], "sonar_location": [1.81926, 0.0, 0.00717], "gps_2_location": [1.05957, -0.00255, -0.20834], "ps_location": [1.28577, 0.0, 0.06725], "rear_right_upwards_thruster_location": [0.273, 0.053, 0.0]})
09:02:40.909 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
09:02:40.909 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for control
09:02:40.909 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 }
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'control' successfully started
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread control with pid: 37953
09:02:40.909 INFO  [robot_code/robot_core/control/src/control_safety.rs:105] Control starting...
09:02:40.909 INFO  [robot_code/robot_core/control/src/control_safety.rs:107] Starting at 0.0
09:02:40.909 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_range_image
09:02:40.912 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: sonar_intensity_image
09:02:40.914 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulated_sonar
09:02:40.914 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 }
09:02:40.914 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulated_sonar' successfully started
09:02:40.914 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulated_sonar with pid: 37956
09:02:40.914 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_manager
09:02:40.914 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:23] Starting thread 'sonar_manager' with StopRunningFlag { name: "sonar_manager", id: 0, stop_running: false, do_auto_stop: true }
09:02:40.914 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'sonar_manager' successfully started
09:02:40.914 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: kinematic_state
09:02:40.914 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread sonar_manager with pid: 37957
09:02:40.915 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: environment_state
09:02:40.915 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: se_debug_stats
09:02:40.920 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for simulator
09:02:40.920 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 }
09:02:40.920 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'simulator' successfully started
09:02:40.920 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread simulator with pid: 37961
09:02:40.950 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: path_planning/meta_info
09:02:40.986 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for path_planner
09:02:40.986 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:99] Starting simulator runner loop
09:02:40.986 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 }
09:02:40.986 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'path_planner' successfully started
09:02:40.986 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for position_camera
09:02:40.986 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_payload
09:02:40.986 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: payload_sessions
09:02:40.986 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread path_planner with pid: 37963
09:02:41.006 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/meta_info
09:02:41.007 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for task_scheduler
09:02:41.007 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 }
09:02:41.007 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'task_scheduler' successfully started
09:02:41.007 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread task_scheduler with pid: 37966
09:02:41.007 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/executor_actions
09:02:41.007 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/logging/src/logger.rs:114] Creating logger to table: task_scheduler/active_tasks
09:02:41.047 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for request_handling_toolbox
09:02:41.047 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
09:02:41.047 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for system_control_input
09:02:41.049 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)]}}}
09:02:41.049 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.
09:02:41.051 DEBUG [robot_code/utilities/settings/src/settings/mod.rs:79] Applying setting overwrites: Object {}
09:02:41.051 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'default'. Description: 
09:02:41.054 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 {"discovery_node": Object {"name": String("simulated_scout")}, "enabled": Bool(false)}, "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)}}, "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)]}}
09:02:41.054 INFO  [robot_code/utilities/settings/src/settings/mod.rs:81] Applied setting overwrite profile 'simulator'. Description: When using the simulator
09:02:41.056 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for communication
09:02:41.056 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 }
09:02:41.056 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'communication' successfully started
09:02:41.056 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread communication with pid: 37977
09:02:41.056 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for discovery_node
09:02:41.056 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for grpc_server
09:02:41.056 INFO  [robot_code/peripherals/communication/src/grpc_handlers/mod.rs:79] grpc listening on 0.0.0.0:10820
09:02:41.056 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for telemetry_stream
09:02:41.056 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for abort
09:02:41.056 INFO  [robot_code/robot_core/launch/src/lib.rs:533] Waiting until code stops running so threads can be joined
09:02:41.056 INFO  [robot_code/robot_core/launch/src/lib.rs:543] Trying to join thread 'control'
09:02:41.067 DEBUG [robot_code/robot_core/task_scheduler/src/lib.rs:216] Received request while idle: GetTaskQueue
09:02:41.067 INFO  [robot_code/peripherals/communication/src/grpc_handlers/sonar_service.rs:54] Creating sonar service
09:02:41.067 DEBUG [robot_code/utilities/common/src/utils/stop_running_flag.rs:60] StopRunningFlag 0 cloned for sonar_service
09:02:41.067 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.
09:02:41.067 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 }
09:02:41.067 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:41] Thread 'discovery_node' successfully started
09:02:41.067 DEBUG [/home/joris/Repos/LobsterAUV/robot_code/utilities/common/src/utils/launch_trait.rs:27] Started thread discovery_node with pid: 37980
09:02:41.068 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:146] Started watching interfaces
09:02:41.068 INFO  [robot_code/peripherals/communication/src/discovery_node.rs:91] Sending heartbeat simulated_scout:318451712@[] to: ["255.255.255.255:10899", "192.168.30.255:10899"]
09:02:41.949 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 47.53Hz
09:02:42.952 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:43.955 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:02:44.958 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:02:45.961 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:02:46.964 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:02:47.967 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:48.970 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:02:49.973 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:50.976 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:51.979 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:52.981 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:53.985 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.84Hz
09:02:54.988 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:02:55.991 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:56.993 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:57.996 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:02:58.999 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:03:00.003 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.79Hz
09:03:01.010 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.69Hz
09:03:02.013 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.83Hz
09:03:03.020 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.66Hz
09:03:04.023 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:03:05.029 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.68Hz
09:03:06.032 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:03:07.035 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz
09:03:08.038 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:03:09.041 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:03:10.044 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.86Hz
09:03:11.047 INFO  [robot_code/robot_core/launch/src/simulator_runner.rs:137] Simulated robot code update rate: 49.85Hz