andrey/k210-sdk-stuff
1
0
Fork 0
mirror of https://github.com/laanwj/k210-sdk-stuff.git synced 2024-11-22 01:16:20 +04:00
Code Issues Projects Releases Wiki Activity

rust/accelerometer: Draw bubble

Browse Source
This commit is contained in:
Wladimir J. van der Laan 2019-05-14 17:09:32 +00:00
parent a7f437c8ce
commit b6676ffcf8
3 changed files with 30 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
README.md
View File

@ -94,7 +94,8 @@ Run tests and benchmarks for the secp256k1 elliptic curve cryptographic library
rust/accelerometer
-----------------
Read measurements from MSA300 accelerometer. Doesn't do anything interesting with them yet.
Read measurements from MSA300 accelerometer. Display a dot on the screen to visualize the current orientation
and magnitude.
[README](rust/accelerometer/README.md)

3
rust/accelerometer/README.md
View File

@ -1,6 +1,7 @@
# `accelerometer`
Read measurements from MSA300 accelerometer.
Read measurements from MSA300 accelerometer. Display a dot on the screen to visualize the current orientation
and magnitude.
## Getting started

29
rust/accelerometer/src/main.rs
View File

@ -54,6 +54,12 @@ fn io_set_power() {
sysctl::set_power_mode(sysctl::power_bank::BANK7, sysctl::io_power_mode::V18);
}
fn sample_cirle(x: i32, y: i32, cx: i32, cy: i32, r: i32, rr: i32) -> bool {
// Early-out based on bounding box
(x - cx).abs() <= r && (y - cy).abs() <= r &&
((x - cx) * (x - cx) + (y - cy) * (y - cy)) <= rr
}
#[entry]
fn main() -> ! {
let p = pac::Peripherals::take().unwrap();
@ -79,12 +85,29 @@ fn main() -> ! {
writeln!(stdout, "MSA300 init").unwrap();
i2c::init(MSA300_SLV_ADDR, MSA300_ADDR_BITS, MSA300_CLK);
msa300::init();
msa300::init().unwrap();
loop {
let (x, y, z) = msa300::measure().unwrap();
let mag = (x*x+y*y+z*z).sqrt();
writeln!(stdout, "m/s^2 x={} y={} z={} (size={})", x, y, z, mag).unwrap();
usleep(100000);
// writeln!(stdout, "m/s^2 x={} y={} z={} (size={})", x, y, z, mag).unwrap();
// draw bubble
let cx = ((y/8.5 + 1.0) * ((DISP_WIDTH / 2) as f32)) as i32;
let cy = ((x/8.5 + 1.0) * ((DISP_HEIGHT / 2) as f32)) as i32;
let r = (1.5*mag) as i32;
let rr = r * r;
let mut idx = 0;
for y in 0..DISP_HEIGHT as i32 {
for x2 in 0..(DISP_WIDTH/2) as i32 {
let x = x2 * 2;
image[idx] = (if sample_cirle(x + 0, y, cx, cy, r, rr) { 0xffff } else { 0 } << 16) |
if sample_cirle(x + 1, y, cx, cy, r, rr) { 0xffff } else { 0 };
idx += 1;
}
}
lcd::draw_picture(0, 0, DISP_WIDTH as u16, DISP_HEIGHT as u16, &image);
// usleep(10000);
}
}