diff --git a/src/sfr.cpp b/src/sfr.cpp index 2c2882fc..dead2761 100644 --- a/src/sfr.cpp +++ b/src/sfr.cpp @@ -12,7 +12,7 @@ namespace sfr { } // namespace boot namespace detumble { // OP Codes 1500 - SFRField min_stable_gyro_z = SFRField((0.8 * sfr::acs::target_spin_rate.get_float() * constants::imu::sfr_resolution), 0x1500, constants::imu::sfr_resolution); // rad/s + SFRField min_stable_gyro_z = SFRField((4.0 * sfr::acs::target_spin_rate.get_float() * constants::imu::sfr_resolution), 0x1500, constants::imu::sfr_resolution); // rad/s SFRField max_stable_gyro_x = SFRField((0.1 * constants::imu::sfr_resolution), 0x1501, constants::imu::sfr_resolution); // rad/s SFRField max_stable_gyro_y = SFRField((0.1 * constants::imu::sfr_resolution), 0x1502, constants::imu::sfr_resolution); // rad/s SFRField min_unstable_gyro_x = SFRField((0.7 * constants::imu::sfr_resolution), 0x1503, constants::imu::sfr_resolution); // rad/s @@ -217,7 +217,7 @@ namespace sfr { SFRField off = SFRField(true, 0x2500); SFRField mode = SFRField((uint8_t)acs_mode_type::detumble, 0x2501); SFRField simple_mag = SFRField((uint8_t)mag_type::z, 0x2502); - SFRField target_spin_rate = SFRField(5.0 * constants::acs::spin_resolution, 0x2503); + SFRField target_spin_rate = SFRField(5.0 * constants::acs::spin_resolution, constants::acs::spin_resolution, 0x2503); SFRField simple_current = SFRField((0 - constants::acs::current_offset) * constants::acs::current_resolution, (-0.25 - constants::acs::current_offset) * constants::acs::current_resolution, (0.25 - constants::acs::current_offset) * constants::acs::current_resolution, 0x2504, constants::acs::current_resolution, constants::acs::current_offset); SFRField on_time = SFRField(5 * constants::time::one_minute, 0, constants::time::one_revolution, 0x2505); SFRField Id_index = SFRField(0, 0, (sizeof(constants::acs::Id_values) / sizeof(constants::acs::Id_values[0])) - 1, 0x2506);