chore: clean up rumble & misc debug stuff

This commit is contained in:
Naxdy 2024-04-03 13:52:19 +02:00
parent d6bb5d5266
commit ef02ca6950
Signed by: Naxdy
GPG key ID: CC15075846BCE91B
3 changed files with 19 additions and 20 deletions

View file

@ -379,7 +379,6 @@ pub const DEFAULT_NOTCH_STATUS: [NotchStatus; NO_OF_NOTCHES] = [
NotchStatus::TertActive,
];
// new default cal points x
#[rustfmt::skip]
const DEFAULT_CAL_POINTS_X: [f32; NO_OF_CALIBRATION_POINTS] = [
0.5279579, 0.37779236, // right
@ -476,7 +475,7 @@ enum NotchAdjustmentType {
/// This needs to be incremented for ANY change to ControllerConfig
/// else we risk loading uninitialized memory.
pub const CONTROLLER_CONFIG_REVISION: u8 = 21;
pub const CONTROLLER_CONFIG_REVISION: u8 = 1;
#[derive(Debug, Clone, Format, PackedStruct)]
#[packed_struct(endian = "msb")]
@ -492,7 +491,7 @@ pub struct StickConfig {
#[packed_field(size_bits = "8")]
pub y_snapback: i8, // not used for CStick
#[packed_field(size_bits = "8")]
pub cardinal_snapping: i8, // not used for CStick
pub cardinal_snapping: i8,
#[packed_field(size_bits = "8")]
pub x_smoothing: u8,
#[packed_field(size_bits = "8")]
@ -549,11 +548,7 @@ impl Default for ControllerConfig {
input_consistency_mode: true,
astick_config: StickConfig::default(),
rumble_strength: 9,
cstick_config: {
let mut cstick = StickConfig::default();
cstick.cardinal_snapping = 0;
cstick
},
cstick_config: StickConfig::default(),
}
}
}
@ -923,10 +918,10 @@ impl<'a> StickCalibrationProcess<'a> {
}
}
if self.calibration_step >= NO_OF_CALIBRATION_POINTS as u8 + NO_OF_ADJ_NOTCHES as u8 {
stick_config.cal_points_x = self.cal_points.map(|p| p.x.into());
stick_config.cal_points_y = self.cal_points.map(|p| p.y.into());
stick_config.cal_points_x = self.cal_points.map(|p| p.x.into());
stick_config.cal_points_y = self.cal_points.map(|p| p.y.into());
if self.calibration_step >= NO_OF_CALIBRATION_POINTS as u8 + NO_OF_ADJ_NOTCHES as u8 {
SIGNAL_CONFIG_CHANGE.signal(self.gcc_config.clone());
info!("Finished calibrating stick {}", self.which_stick);
@ -1634,7 +1629,7 @@ pub async fn config_task(
info!("Config task is running.");
Timer::after_millis(1000).await;
Timer::after_millis(100).await;
let new_config = ControllerConfig::from_flash_memory(&mut flash).unwrap();

View file

@ -185,6 +185,8 @@ async fn update_stick_states(
trace!("Raw Control Stick: {}", raw_controlstick);
trace!("Raw CSTICK: {:?}", raw_cstick);
raw_stick_values.a_raw = raw_controlstick;
raw_stick_values.c_raw = raw_cstick;
@ -252,7 +254,7 @@ async fn update_stick_states(
// phob optionally runs a median filter here, but we leave it for now
trace!("Controlstick position: {}, {}", pos_x, pos_y);
trace!("Cstick position: {}, {}", pos_cx, pos_cy);
let mut remapped = match notch_remap(
pos_x,
@ -291,7 +293,11 @@ async fn update_stick_states(
(x, y) => XyValuePair { x, y },
};
trace!("Remapped Control Stick: {}", remapped);
trace!(
"Remapped Control Stick: {}; C stick: {}",
remapped,
remapped_c
);
remapped = XyValuePair {
x: fminf(125., fmaxf(-125., remapped.x)),
@ -507,7 +513,7 @@ pub async fn update_stick_states_task(
spi_ccs: Output<'static, AnyPin>,
mut controller_config: ControllerConfig,
) {
Timer::after_secs(5).await;
Timer::after_secs(1).await;
*SPI_SHARED.lock().await = Some(spi);
*SPI_ACS_SHARED.lock().await = Some(spi_acs);
*SPI_CCS_SHARED.lock().await = Some(spi_ccs);
@ -516,8 +522,6 @@ pub async fn update_stick_states_task(
let mut cstick_params = StickParams::from_stick_config(&controller_config.cstick_config);
let mut filter_gains = FILTER_GAINS.get_normalized_gains(&controller_config);
info!("Controlstick params: {:?}", controlstick_params);
let mut current_stick_state = StickState {
ax: 127,
ay: 127,
@ -582,6 +586,9 @@ pub async fn update_stick_states_task(
controlstick_params = StickParams::from_stick_config(&controller_config.astick_config);
cstick_params = StickParams::from_stick_config(&controller_config.cstick_config);
filter_gains = FILTER_GAINS.get_normalized_gains(&controller_config);
info!("Controlstick params: {:?}", controlstick_params);
info!("CStick params: {:?}", cstick_params);
}
}
}

View file

@ -94,9 +94,6 @@ fn main() -> ! {
let pwm_rumble = Pwm::new_output_b(p.PWM_CH4, p.PIN_25, rumble_config.clone());
let pwm_brake = Pwm::new_output_b(p.PWM_CH6, p.PIN_29, brake_config.clone());
pwm_rumble.set_counter(0);
pwm_brake.set_counter(255);
spawn_core1(p.CORE1, unsafe { &mut CORE1_STACK }, move || {
let executor1 = EXECUTOR1.init(Executor::new());
debug!("Mana");