Completed BSP core features
- Added basic accelerometer example. Board in not populated so it is not complete, but it provides a starting point - Added ADC base library and example building on the new `max116xx-10bit` device driver crate
This commit is contained in:
@@ -0,0 +1,89 @@
|
||||
//! ADXL343 accelerometer example
|
||||
//!
|
||||
//! Please note that the default REB1 board is not populated with the ADXL343BCCZ-RL7.
|
||||
//! To use this example, this chip needs to be soldered onto the board.
|
||||
#![no_main]
|
||||
#![no_std]
|
||||
use cortex_m_rt::entry;
|
||||
use embedded_hal::spi;
|
||||
use panic_rtt_target as _;
|
||||
use rtt_target::{rprintln, rtt_init_print};
|
||||
use va108xx_hal::{
|
||||
gpio::PinsA,
|
||||
pac::{self, interrupt},
|
||||
prelude::*,
|
||||
spi::{Spi, SpiConfig, TransferConfig},
|
||||
timer::{default_ms_irq_handler, set_up_ms_timer, Delay},
|
||||
};
|
||||
|
||||
const READ_MASK: u8 = 1 << 7;
|
||||
const _MULTI_BYTE_MASK: u8 = 1 << 6;
|
||||
const DEVID_REG: u8 = 0x00;
|
||||
|
||||
const POWER_CTL_REG: u8 = 0x2D;
|
||||
const PWR_MEASUREMENT_MODE_MASK: u8 = 1 << 3;
|
||||
|
||||
#[entry]
|
||||
fn main() -> ! {
|
||||
rtt_init_print!();
|
||||
rprintln!("-- Vorago Accelerometer Example --");
|
||||
let mut dp = pac::Peripherals::take().unwrap();
|
||||
let tim0 = set_up_ms_timer(
|
||||
&mut dp.SYSCONFIG,
|
||||
&mut dp.IRQSEL,
|
||||
50.mhz().into(),
|
||||
dp.TIM0,
|
||||
interrupt::OC0,
|
||||
);
|
||||
let mut delay = Delay::new(tim0);
|
||||
unsafe {
|
||||
cortex_m::peripheral::NVIC::unmask(pac::Interrupt::OC0);
|
||||
}
|
||||
|
||||
let pinsa = PinsA::new(&mut dp.SYSCONFIG, None, dp.PORTA);
|
||||
let spi_cfg = SpiConfig::default();
|
||||
let (sck, mosi, miso) = (
|
||||
pinsa.pa20.into_funsel_2(),
|
||||
pinsa.pa19.into_funsel_2(),
|
||||
pinsa.pa18.into_funsel_2(),
|
||||
);
|
||||
let cs_pin = pinsa.pa16.into_funsel_2();
|
||||
|
||||
// Need to set the ADC chip select low
|
||||
let mut adc_cs = pinsa.pa17.into_push_pull_output();
|
||||
adc_cs
|
||||
.set_high()
|
||||
.expect("Setting ADC chip select high failed");
|
||||
|
||||
let transfer_cfg = TransferConfig::new(1.mhz(), spi::MODE_3, Some(cs_pin), false, true);
|
||||
let mut spi = Spi::spib(
|
||||
dp.SPIB,
|
||||
(sck, miso, mosi),
|
||||
50.mhz(),
|
||||
spi_cfg,
|
||||
Some(&mut dp.SYSCONFIG),
|
||||
Some(&transfer_cfg.downgrade()),
|
||||
);
|
||||
|
||||
let mut send_buf: [u8; 3] = [0; 3];
|
||||
send_buf[0] = READ_MASK | DEVID_REG;
|
||||
let reply = spi
|
||||
.transfer(&mut send_buf[0..2])
|
||||
.expect("Reading DEVID register failed");
|
||||
rprintln!("DEVID register: {}", reply[1]);
|
||||
|
||||
send_buf[0] = POWER_CTL_REG;
|
||||
send_buf[1] = PWR_MEASUREMENT_MODE_MASK;
|
||||
spi.write(&send_buf[0..2])
|
||||
.expect("Enabling measurement mode failed");
|
||||
|
||||
loop {
|
||||
delay.delay_ms(500);
|
||||
todo!("Not implemented for now, is not populated on the board..");
|
||||
}
|
||||
}
|
||||
|
||||
#[interrupt]
|
||||
fn OC0() {
|
||||
default_ms_irq_handler();
|
||||
}
|
||||
Reference in New Issue
Block a user