Skip to content

Commit

Permalink
Merge pull request #315 from ut-issl/feature/test_magbias
Browse files Browse the repository at this point in the history
磁気センサバイアス再調整
  • Loading branch information
ogoogo authored May 24, 2024
2 parents 9364f0f + 2f79af1 commit d56cacd
Show file tree
Hide file tree
Showing 8 changed files with 25 additions and 25 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -24,5 +24,5 @@ float NANOSSOC_D60_PARAMETERS_sun_intensity_lower_threshold_percent = 80.0f;
float NANOSSOC_D60_PARAMETERS_sun_intensity_upper_threshold_percent = 120.0f;

// Magnetic sensor bias calibration
const float NANOSSOC_D60_PARAMETERS_mag_bias_rm3100_aobc_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 186.15f, 110.34f, 91.00f };
const float NANOSSOC_D60_PARAMETERS_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = { -19.59f, -69.73f, -39.56f };
const float NANOSSOC_D60_PARAMETERS_mag_bias_rm3100_aobc_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 215.09f, 92.66f, 169.0f };
const float NANOSSOC_D60_PARAMETERS_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 78.02f, 21.57f, 5.01f };
Original file line number Diff line number Diff line change
Expand Up @@ -22,4 +22,4 @@ double OEM7600_PARAMETERS_total_gps_time_spike_filter_config_reject_threshold_s
double OEM7600_PARAMETERS_total_gps_time_spike_filter_config_amplitude_limit_to_accept_as_step_s = 3000.0;

// Magnetic sensor bias calibration
const float OEM7600_PARAMETERS_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = {-50.13f, 259.41f, -219.48f};
const float OEM7600_PARAMETERS_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 172.9f, 132.60f, -16.9f};
Original file line number Diff line number Diff line change
Expand Up @@ -8,7 +8,7 @@
// AOBC RM3100
// Magnetometer bias
// The following parameter should be tuned with magnetic experiment
const float RM3100_PARAMETERS_mag_aobc_bias_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 2692.75f, -77195.48f, 25628.46f };
const float RM3100_PARAMETERS_mag_aobc_bias_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 30115.84f, -2553.2f, -3568.5f };

// Magnetometer filter
// 1st order Low Pass Filter
Expand All @@ -26,7 +26,7 @@ const Quaternion RM3100_PARAMETERS_mag_ext_quaternion_c2b = {-0.707106471, 0.707

// Magnetometer bias
// The following parameter should be tuned with magnetic experiment
const float RM3100_PARAMETERS_mag_ext_bias_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 36739.17f, -1727.35f, 3670.1f };
const float RM3100_PARAMETERS_mag_ext_bias_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 85.8f, -2869.13f, -4803.5f };

// Magnetometer filter
// 1st order Low Pass Filter
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -13,6 +13,6 @@ double SAGITTA_PARAMETERS_q_i2b_spike_filter_config_reject_threshold_rad = PARAM
double SAGITTA_PARAMETERS_q_i2b_spike_filter_config_amplitude_limit_to_accept_as_step_rad = PARAMETER_SETTING_MACRO_DEGREE_TO_RADIAN(0.6f);

// Magnetic sensor bias calibration
const float SAGITTA_PARAMETERS_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 16.28f, 107.19f, -81.11f }; //!< Magnetic sensor bias calibration
const float SAGITTA_PARAMETERS_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = {71.50f, 70.20f, -14.3f}; //!< Magnetic sensor bias calibration

// Sun intensity threshold
Original file line number Diff line number Diff line change
Expand Up @@ -30,4 +30,4 @@ const float STIM210_PARAMETERS_gyro_spike_reject_threshold_rad_s[PHYSICAL_CONST_
const float STIM210_PARAMETERS_gyro_spike_amplitude_limit_to_accept_as_step_rad_s[PHYSICAL_CONST_THREE_DIM] = { 0.002f, 0.002f, 0.002f };

// Magnetic sensor bias calibration
const float STIM210_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = { -15.45f, 111.48f, -101.68f };
const float STIM210_mag_bias_rm3100_ext_compo_nT[PHYSICAL_CONST_THREE_DIM] = { 86.94f, 43.95f, 30.08f};
12 changes: 6 additions & 6 deletions src/src_user/TlmCmd/NormalBlockCommandDefinition/nbc_oem7600.c
Original file line number Diff line number Diff line change
Expand Up @@ -60,9 +60,9 @@ void BCL_load_power_on_oem7600(void)
#ifndef SILS_FW // TODO_L S2Eに電源ON/OFFでのバイアス変更機能を追加する
// 磁気バイアス補正
BCL_tool_prepare_param_uint8(RM3100_IDX_ON_AOBC);
BCL_tool_prepare_param_float(654.19f);
BCL_tool_prepare_param_float(374.0f);
BCL_tool_prepare_param_float(348.14f);
BCL_tool_prepare_param_float(773.50f);
BCL_tool_prepare_param_float(292.5f);
BCL_tool_prepare_param_float(521.30f);
BCL_tool_prepare_param_uint8(1); // Add

BCL_tool_register_cmd(bc_cycle, Cmd_CODE_DI_RM3100_SET_MAG_BIAS_COMPO_NT);
Expand Down Expand Up @@ -101,9 +101,9 @@ void BCL_load_power_off_oem7600(void)
#ifndef SILS_FW // TODO_L S2Eに電源ON/OFFでのバイアス変更機能を追加する
// 磁気バイアス補正
BCL_tool_prepare_param_uint8(RM3100_IDX_ON_AOBC);
BCL_tool_prepare_param_float(-654.19f);
BCL_tool_prepare_param_float(-374.0f);
BCL_tool_prepare_param_float(-348.14f);
BCL_tool_prepare_param_float(-773.50f);
BCL_tool_prepare_param_float(-292.5f);
BCL_tool_prepare_param_float(-521.30f);
BCL_tool_prepare_param_uint8(1); // Add

BCL_tool_register_cmd(bc_cycle, Cmd_CODE_DI_RM3100_SET_MAG_BIAS_COMPO_NT);
Expand Down
12 changes: 6 additions & 6 deletions src/src_user/TlmCmd/NormalBlockCommandDefinition/nbc_sagitta.c
Original file line number Diff line number Diff line change
Expand Up @@ -48,9 +48,9 @@ void BCL_load_power_on_sagitta(void)
#ifndef SILS_FW // TODO_L S2Eに電源ON/OFFでのバイアス変更機能を追加する
// 磁気バイアス補正
BCL_tool_prepare_param_uint8(RM3100_IDX_ON_AOBC);
BCL_tool_prepare_param_float(445.64f);
BCL_tool_prepare_param_float(478.48f);
BCL_tool_prepare_param_float(-885.402f);
BCL_tool_prepare_param_float(443.30f);
BCL_tool_prepare_param_float(640.9f);
BCL_tool_prepare_param_float(-1457.30f);
BCL_tool_prepare_param_uint8(1); // Add

BCL_tool_register_cmd(bc_cycle, Cmd_CODE_DI_RM3100_SET_MAG_BIAS_COMPO_NT);
Expand Down Expand Up @@ -108,9 +108,9 @@ void BCL_load_power_off_sagitta(void)
#ifndef SILS_FW // TODO_L S2Eに電源ON/OFFでのバイアス変更機能を追加する
// 磁気バイアス補正
BCL_tool_prepare_param_uint8(RM3100_IDX_ON_AOBC);
BCL_tool_prepare_param_float(-445.64f);
BCL_tool_prepare_param_float(-478.48f);
BCL_tool_prepare_param_float(885.402f);
BCL_tool_prepare_param_float(-443.30f);
BCL_tool_prepare_param_float(-640.9f);
BCL_tool_prepare_param_float(1457.30f);
BCL_tool_prepare_param_uint8(1); // Add

BCL_tool_register_cmd(bc_cycle, Cmd_CODE_DI_RM3100_SET_MAG_BIAS_COMPO_NT);
Expand Down
12 changes: 6 additions & 6 deletions src/src_user/TlmCmd/NormalBlockCommandDefinition/nbc_stim210.c
Original file line number Diff line number Diff line change
Expand Up @@ -47,9 +47,9 @@ void BCL_load_power_on_stim210(void)
#ifndef SILS_FW // TODO_L S2Eに電源ON/OFFでのバイアス変更機能を追加する
// 磁気バイアス補正
BCL_tool_prepare_param_uint8(RM3100_IDX_ON_AOBC);
BCL_tool_prepare_param_float(370.26f);
BCL_tool_prepare_param_float(224.98f);
BCL_tool_prepare_param_float(34.26f);
BCL_tool_prepare_param_float(364.75f);
BCL_tool_prepare_param_float(443.0f);
BCL_tool_prepare_param_float(-1061.14f);
BCL_tool_prepare_param_uint8(1); // Add

BCL_tool_register_cmd(bc_cycle, Cmd_CODE_DI_RM3100_SET_MAG_BIAS_COMPO_NT);
Expand Down Expand Up @@ -130,9 +130,9 @@ void BCL_load_power_off_stim210(void)
#ifndef SILS_FW // TODO_L S2Eに電源ON/OFFでのバイアス変更機能を追加する
// 磁気バイアス補正
BCL_tool_prepare_param_uint8(RM3100_IDX_ON_AOBC);
BCL_tool_prepare_param_float(-370.26f);
BCL_tool_prepare_param_float(-224.98f);
BCL_tool_prepare_param_float(-34.26f);
BCL_tool_prepare_param_float(-364.75f);
BCL_tool_prepare_param_float(-443.0f);
BCL_tool_prepare_param_float(1061.14f);
BCL_tool_prepare_param_uint8(1); // Add

BCL_tool_register_cmd(bc_cycle, Cmd_CODE_DI_RM3100_SET_MAG_BIAS_COMPO_NT);
Expand Down

0 comments on commit d56cacd

Please sign in to comment.