rust/comprehensive-rust
1
0
Fork 0
mirror of https://github.com/google/comprehensive-rust.git synced 2025-04-20 06:58:03 +02:00
Code Issues Releases Activity

Display accelerometer rather than compass.

Browse Source
This commit is contained in:
Andrew Walbran 2023-03-09 14:47:30 +00:00
parent 44a4b4b234
commit 8f2a851e95
1 changed files with 13 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
src/exercises/bare-metal/compass/src/main.rs
View File

@ -22,7 +22,7 @@ use core::fmt::Write;
use cortex_m_rt::entry; use cortex_m_rt::entry;
// ANCHOR_END: top // ANCHOR_END: top
use core::cmp::{max, min}; use core::cmp::{max, min};
use lsm303agr::{Lsm303agr, MagOutputDataRate}; use lsm303agr::{AccelOutputDataRate, Lsm303agr, MagOutputDataRate};
use microbit::{ use microbit::{
display::blocking::Display, display::blocking::Display,
hal::{ hal::{
@ -56,6 +56,7 @@ fn main() -> ! {
let mut imu = Lsm303agr::new_with_i2c(i2c); let mut imu = Lsm303agr::new_with_i2c(i2c);
imu.init().unwrap(); imu.init().unwrap();
imu.set_mag_odr(MagOutputDataRate::Hz50).unwrap(); imu.set_mag_odr(MagOutputDataRate::Hz50).unwrap();
imu.set_accel_odr(AccelOutputDataRate::Hz50).unwrap();
let mut imu = imu.into_mag_continuous().ok().unwrap(); let mut imu = imu.into_mag_continuous().ok().unwrap();
// Set up display and timer. // Set up display and timer.
@ -70,16 +71,25 @@ fn main() -> ! {
// ANCHOR_END: loop // ANCHOR_END: loop
while !imu.mag_status().unwrap().xyz_new_data {} while !imu.mag_status().unwrap().xyz_new_data {}
let compass_reading = imu.mag_data().unwrap(); let compass_reading = imu.mag_data().unwrap();
while !imu.accel_status().unwrap().xyz_new_data {}
let accelerometer_reading = imu.accel_data().unwrap();
writeln!( writeln!(
serial, serial,
"{},{},{}", "{},{},{}\t{},{},{}",
compass_reading.x, compass_reading.y, compass_reading.z compass_reading.x,
compass_reading.y,
compass_reading.z,
accelerometer_reading.x,
accelerometer_reading.y,
accelerometer_reading.z,
) )
.unwrap(); .unwrap();
let mut image = [[0; 5]; 5]; let mut image = [[0; 5]; 5];
let x = scale(-compass_reading.x, -COMPASS_SCALE, COMPASS_SCALE, 0, 4) as usize; let x = scale(-compass_reading.x, -COMPASS_SCALE, COMPASS_SCALE, 0, 4) as usize;
let y = scale(compass_reading.y, -COMPASS_SCALE, COMPASS_SCALE, 0, 4) as usize; let y = scale(compass_reading.y, -COMPASS_SCALE, COMPASS_SCALE, 0, 4) as usize;
let x = scale(accelerometer_reading.x, -700, 700, 0, 4) as usize;
let y = scale(-accelerometer_reading.y, -700, 700, 0, 4) as usize;
image[y][x] = 255; image[y][x] = 255;
display.show(&mut timer, image, 100); display.show(&mut timer, image, 100);
} }