From 3bf71c66f63f33471b172570a3a20710d6fe6b72 Mon Sep 17 00:00:00 2001 From: Trygve Laugstøl Date: Fri, 1 Jul 2016 09:21:18 +0200 Subject: o Initial commit. --- apps/CMakeLists.txt | 2 + apps/accel/CMakeLists.txt | 3 + apps/accel/main.c | 107 ++++++++++++++++++++++++++++++++ apps/magneto/CMakeLists.txt | 4 ++ apps/magneto/main.c | 146 ++++++++++++++++++++++++++++++++++++++++++++ 5 files changed, 262 insertions(+) create mode 100644 apps/CMakeLists.txt create mode 100644 apps/accel/CMakeLists.txt create mode 100644 apps/accel/main.c create mode 100644 apps/magneto/CMakeLists.txt create mode 100644 apps/magneto/main.c (limited to 'apps') diff --git a/apps/CMakeLists.txt b/apps/CMakeLists.txt new file mode 100644 index 0000000..973af05 --- /dev/null +++ b/apps/CMakeLists.txt @@ -0,0 +1,2 @@ +add_subdirectory(accel) +#add_subdirectory(magneto) diff --git a/apps/accel/CMakeLists.txt b/apps/accel/CMakeLists.txt new file mode 100644 index 0000000..91f1497 --- /dev/null +++ b/apps/accel/CMakeLists.txt @@ -0,0 +1,3 @@ +add_executable(accel main.c) +set_target_properties(accel PROPERTIES CHIP QUARK_D2000) +toolchain_target(accel) diff --git a/apps/accel/main.c b/apps/accel/main.c new file mode 100644 index 0000000..b27b2b4 --- /dev/null +++ b/apps/accel/main.c @@ -0,0 +1,107 @@ +/* + * Copyright (c) 2015, Intel Corporation + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright notice, + * this list of conditions and the following disclaimer in the documentation + * and/or other materials provided with the distribution. + * 3. Neither the name of the Intel Corporation nor the names of its + * contributors may be used to endorse or promote products derived from this + * software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE INTEL CORPORATION OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include + +#if (__IPP_ENABLED__) +#include "dsp.h" +#endif + +#include "qm_interrupt.h" +#include "qm_rtc.h" + +#include "bmc150/bmc150.h" + +#define ALARM (QM_RTC_ALARM_SECOND >> 3) + +#if (__IPP_ENABLED__) +#define SAMPLES_SIZE 15 + +static float32_t samples[SAMPLES_SIZE]; + +static void print_axis_stats(int16_t value) +{ + static uint16_t index = 0; + static uint16_t count = 0; + float32_t mean, var, rms; + + samples[index] = value; + index = (index + 1) % SAMPLES_SIZE; + + count = count == SAMPLES_SIZE ? SAMPLES_SIZE : count + 1; + + ippsq_rms_f32(samples, count, &rms); + ippsq_var_f32(samples, count, &var); + ippsq_mean_f32(samples, count, &mean); + + QM_PRINTF("rms %d var %d mean %d\n", (int) rms, (int) var, (int) mean); +} +#endif + +static void print_accel_callback(void) +{ + bmc150_accel_t accel = {0}; + qm_rc_t rc; + + (void) rc; + + rc = bmc150_read_accel(&accel); + QM_PRINTF("rc %d x %d y %d z %d\n", rc, accel.x, accel.y, accel.z); + +#if (__IPP_ENABLED__) + print_axis_stats(accel.z); +#endif + + qm_rtc_set_alarm(QM_RTC_0, (QM_RTC[QM_RTC_0].rtc_ccvr + ALARM)); +} + +int main(void) +{ + qm_rtc_config_t rtc; + + QM_PUTS("Accelerometer example app\n"); + + rtc.init_val = 0; + rtc.alarm_en = true; + rtc.alarm_val = ALARM; + rtc.callback = print_accel_callback; + + qm_irq_request(QM_IRQ_RTC_0, qm_rtc_isr_0); + + clk_periph_enable(CLK_PERIPH_RTC_REGISTER | CLK_PERIPH_CLK); + + bmc150_init(BMC150_J14_POS_0); + + bmc150_set_accel_mode(BMC150_MODE_2G); + bmc150_set_bandwidth(BMC150_BANDWIDTH_64MS); + + qm_rtc_set_config(QM_RTC_0, &rtc); + + return 0; +} diff --git a/apps/magneto/CMakeLists.txt b/apps/magneto/CMakeLists.txt new file mode 100644 index 0000000..e1ae3d1 --- /dev/null +++ b/apps/magneto/CMakeLists.txt @@ -0,0 +1,4 @@ +add_executable(magneto main.c) +set_target_properties(magneto PROPERTIES CHIP QUARK_D2000) + +#target_compile_definitions(magneto -D__IPP__) diff --git a/apps/magneto/main.c b/apps/magneto/main.c new file mode 100644 index 0000000..df19ae1 --- /dev/null +++ b/apps/magneto/main.c @@ -0,0 +1,146 @@ +/* + * Copyright (c) 2016, Intel Corporation + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright notice, + * this list of conditions and the following disclaimer in the documentation + * and/or other materials provided with the distribution. + * 3. Neither the name of the Intel Corporation nor the names of its + * contributors may be used to endorse or promote products derived from this + * software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE INTEL CORPORATION OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include +#include + +#include "qm_interrupt.h" +#include "qm_rtc.h" +#include "qm_uart.h" + +#include "bmx1xx/bmx1xx.h" + +#define ALARM (QM_RTC_ALARM_SECOND >> 3) + +#define M_PI 3.14159265358979323846 + +#if (QUARK_D2000) + +#define SAMPLING_DURATION 500 +static uint16_t cb_count = 0; + +static const char *degrees_to_direction(unsigned int deg) +{ + if (deg >= 360) { + deg %= 360; + } + + if (deg >= 338 || deg < 23) { + return "N"; + } else if (deg < 68) { + return "NE"; + } else if (deg < 113) { + return "E"; + } else if (deg < 158) { + return "SE"; + } else if (deg < 203) { + return "S"; + } else if (deg < 248) { + return "SW"; + } else if (deg < 293) { + return "W"; + } else { + return "NW"; + } +} + +static void print_magneto_callback(void *data) +{ + bmx1xx_mag_t mag = {0}; + double heading; + int deg; + + bmx1xx_read_mag(&mag); + + heading = atan2(mag.y, mag.x); + + if (heading < 0) { + heading += 2 * M_PI; + } + + deg = (int)(heading * 180 / M_PI); + + QM_PRINTF("mag x %d y %d z %d deg %d direction %s\n", mag.x, mag.y, + mag.z, deg, degrees_to_direction(deg)); + + if (cb_count < SAMPLING_DURATION) { + qm_rtc_set_alarm(QM_RTC_0, (QM_RTC[QM_RTC_0].rtc_ccvr + ALARM)); + cb_count++; + } else { + QM_PUTS("Finished: Magnetometer example app\n"); + } +} +#endif + +int main(void) +{ +#if (QUARK_D2000) + bmx1xx_setup_config_t cfg; + qm_rtc_config_t rtc; +#endif + int rc = 0; + + QM_PUTS("Starting: Magnetometer example app\n"); + +#if (QUARK_D2000) + rtc.init_val = 0; + rtc.alarm_en = true; + rtc.alarm_val = ALARM; + rtc.callback = print_magneto_callback; + rtc.callback_data = NULL; + + qm_irq_request(QM_IRQ_RTC_0, qm_rtc_isr_0); + + clk_periph_enable(CLK_PERIPH_RTC_REGISTER | CLK_PERIPH_CLK); + + cfg.pos = BMC150_J14_POS_0; + + rc = bmx1xx_init(cfg); + if (rc != 0) { + return rc; + } + + rc = bmx1xx_mag_set_power(BMX1XX_MAG_POWER_ACTIVE); + if (rc != 0) { + return rc; + } + + rc = bmx1xx_mag_set_preset(BMX1XX_MAG_PRESET_HIGH_ACCURACY); + if (rc != 0) { + return rc; + } + + qm_rtc_set_config(QM_RTC_0, &rtc); + +#else + QM_PUTS("Mag sensor app not available for Quark SE dev board\n"); + QM_PUTS("Finished: Magnetometer example app\n"); +#endif + return rc; +} -- cgit v1.2.3