1 files changed, 146 insertions, 0 deletions
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 <unistd.h>
+#include <math.h>
+
+#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;
+}