diff --git a/spinnyboy_rust/src/bin/main.rs b/spinnyboy_rust/src/bin/main.rs index b621a30..97ab0f0 100644 --- a/spinnyboy_rust/src/bin/main.rs +++ b/spinnyboy_rust/src/bin/main.rs @@ -5,15 +5,17 @@ reason = "mem::forget is generally not safe to do with esp_hal types, especially those \ holding buffers for the duration of a data transfer." )] +use core::fmt::Write; +use esp_hal::uart::{Config, Uart}; use esp_hal::clock::CpuClock; +use esp_hal::delay::Delay; +use esp_hal::main; use esp_hal::mcpwm::operator::PwmPinConfig; use esp_hal::mcpwm::timer::PwmWorkingMode; use esp_hal::time::Rate; -use esp_hal::timer::timg::TimerGroup; -use esp_hal::main; use esp_hal::time::{Duration, Instant}; -use esp_hal::delay::Delay; +use esp_hal::timer::timg::TimerGroup; use rtt_target::rprintln; mod dc_driver; use dc_driver::afroesc::AfroEsc; @@ -40,36 +42,49 @@ fn main() -> ! { let mut delay = Delay::new(); esp_alloc::heap_allocator!(#[esp_hal::ram(reclaimed)] size: 65536); - let clock_config = esp_hal::mcpwm::PeripheralClockConfig::with_frequency(Rate::from_mhz(32)).unwrap(); + let clock_config = + esp_hal::mcpwm::PeripheralClockConfig::with_frequency(Rate::from_mhz(32)).unwrap(); let mut mcpwm = esp_hal::mcpwm::McPwm::new(peripherals.MCPWM0, clock_config); mcpwm.operator0.set_timer(&mcpwm.timer0); let pin = peripherals.GPIO18; - let mut pwm_pin = mcpwm.operator0.with_pin_a(pin, PwmPinConfig::UP_ACTIVE_HIGH); - let timer_clock_cfg = clock_config + let mut pwm_pin = mcpwm + .operator0 + .with_pin_a(pin, PwmPinConfig::UP_ACTIVE_HIGH); + let timer_clock_cfg = clock_config .timer_clock_with_frequency(19_999, PwmWorkingMode::Increase, Rate::from_hz(50)) .unwrap(); mcpwm.timer0.start(timer_clock_cfg); let mut esc = AfroEsc::new(&mut pwm_pin); esc.set_timestamp(1000); - delay.delay_millis(3000); - esc.set_duty_percent(10); - delay.delay_millis(3000); + delay.delay_millis(3000); + esc.set_duty_percent(10); + delay.delay_millis(3000); //1421 is I think the best, makes calculating the throttle easier esc.set_timestamp(1055); - delay.delay_millis(3000); + delay.delay_millis(3000); + let mut uart0 = Uart::new(peripherals.UART0, Config::default().with_baudrate(9600)) + .unwrap() + .with_rx(peripherals.GPIO9) + .with_tx(peripherals.GPIO10); + uart0.write(b"page page1"); + uart0.write(b"\xff"); + uart0.write(b"\xff"); + uart0.write(b"\xff"); + uart0.write(b"\xff"); + rprintln!("WRITE HAPPENED!"); // Example: Ramp from 0% to 50% throttle - //the afro esc starts turning at roughly setup gets a PWM at + //the afro esc starts turning at roughly setup gets a PWM at //loop{ // for pulse in 1120..1500 { // rprintln!("pulse:{}",pulse); // pwm_pin.set_timestamp(pulse); // Timer::after_millis(3000).await; // } - + // Timer::after_millis(1000).await; - + // // Return to idle // pwm_pin.set_timestamp(1000); // Timer::after_millis(1000).await; @@ -77,8 +92,7 @@ fn main() -> ! { loop { rprintln!("Hello world!"); - delay.delay_millis(3000); - + delay.delay_millis(3000); } // for inspiration have a look at the examples at https://github.com/esp-rs/esp-hal/tree/esp-hal-v1.0.0/examples/src/bin