92 lines
2.4 KiB
C
92 lines
2.4 KiB
C
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <math.h>
|
|
#include "watch.h"
|
|
#include "lis2dh.h"
|
|
|
|
// This application displays data from the old Sensor Watch Motion sensor board.
|
|
// Note that this board required A0 to be set high to power the sensor.
|
|
// Future accelerometer boards will be powered directly from VCC.
|
|
// Also note that this board has its INT1 pin wired to A1, which is not an external
|
|
// wake pin. Future accelerometer boards will wire interrupt pins to A2 and A4.
|
|
|
|
uint8_t axis = 0;
|
|
|
|
void cb_light_pressed() {
|
|
axis = 1;
|
|
}
|
|
|
|
void cb_mode_pressed() {
|
|
axis = 2;
|
|
}
|
|
|
|
void cb_alarm_pressed() {
|
|
axis = 3;
|
|
}
|
|
|
|
void app_init() {
|
|
gpio_set_pin_direction(A0, GPIO_DIRECTION_OUT);
|
|
gpio_set_pin_function(A0, GPIO_PIN_FUNCTION_OFF);
|
|
gpio_set_pin_level(A0, true);
|
|
|
|
watch_enable_display();
|
|
|
|
watch_enable_external_interrupts();
|
|
watch_register_interrupt_callback(BTN_MODE, cb_mode_pressed, INTERRUPT_TRIGGER_RISING);
|
|
watch_register_interrupt_callback(BTN_LIGHT, cb_light_pressed, INTERRUPT_TRIGGER_RISING);
|
|
watch_register_interrupt_callback(BTN_ALARM, cb_alarm_pressed, INTERRUPT_TRIGGER_RISING);
|
|
|
|
watch_enable_i2c();
|
|
|
|
lis2dh_begin();
|
|
|
|
lis2dh_set_range(LIS2DH_RANGE_2_G);
|
|
lis2dh_set_data_rate(LIS2DH_DATA_RATE_10_HZ);
|
|
}
|
|
|
|
void app_wake_from_backup() {
|
|
}
|
|
|
|
void app_setup() {
|
|
}
|
|
|
|
void app_prepare_for_standby() {
|
|
}
|
|
|
|
void app_wake_from_standby() {
|
|
}
|
|
|
|
bool app_loop() {
|
|
if (lis2dh_have_new_data()) {
|
|
lis2dh_reading reading;
|
|
lis2dh_acceleration_measurement measurement = lis2dh_get_acceleration_measurement(&reading);
|
|
|
|
// printf("%d,%d,%d\n", reading.x, reading.y, reading.z);
|
|
printf("%f,%f,%f\n", measurement.x, measurement.y, measurement.z);
|
|
|
|
char buf[11] = {0};
|
|
switch (axis) {
|
|
case 1:
|
|
sprintf(buf, "AC X%-6d", reading.x);
|
|
break;
|
|
case 2:
|
|
sprintf(buf, "AC Y%-6d", reading.y);
|
|
break;
|
|
case 3:
|
|
sprintf(buf, "AC Z%-6d", reading.z);
|
|
break;
|
|
default:
|
|
sprintf(buf, " %2d%2d%2d", abs(reading.x >> 9), abs(reading.y >> 9), abs(reading.z >> 9));
|
|
if (reading.x < 0) buf[0] = '_';
|
|
if (reading.y < 0) buf[1] = '_';
|
|
if (reading.z < 0) buf[3] = '_';
|
|
break;
|
|
}
|
|
|
|
watch_display_string(buf, 0);
|
|
}
|
|
|
|
return false;
|
|
}
|