Added MEMS support to the STM32F4-Discovery demo.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@3702 35acf78f-673a-0410-8e92-d51de3d6d3f4

2 files changed, 176 insertions, 0 deletions

diff --git a/os/various/lis302dl.c b/os/various/lis302dl.c
new file mode 100644
index 000000000..48e8ce200
--- /dev/null
+++ b/os/various/lis302dl.c
@@ -0,0 +1,103 @@
+/*

+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,

+                 2011 Giovanni Di Sirio.

+

+    This file is part of ChibiOS/RT.

+

+    ChibiOS/RT is free software; you can redistribute it and/or modify

+    it under the terms of the GNU General Public License as published by

+    the Free Software Foundation; either version 3 of the License, or

+    (at your option) any later version.

+

+    ChibiOS/RT is distributed in the hope that it will be useful,

+    but WITHOUT ANY WARRANTY; without even the implied warranty of

+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

+    GNU General Public License for more details.

+

+    You should have received a copy of the GNU General Public License

+    along with this program.  If not, see <http://www.gnu.org/licenses/>.

+*/

+

+/**

+ * @file    lis302dl.c

+ * @brief   LIS302DL MEMS interface module through SPI code.

+ *

+ * @addtogroup lis302dl

+ * @{

+ */

+

+#include "ch.h"

+#include "hal.h"

+#include "lis302dl.h"

+

+static uint8_t txbuf[2];

+static uint8_t rxbuf[2];

+

+/**

+ * @brief   Reads a register value.

+ * @pre     The SPI interface must be initialized and the driver started.

+ *

+ * @param[in] spip      pointer to the SPI initerface

+ * @param[in] reg       register number

+ * @return              The register value.

+ */

+uint8_t lis302dlReadRegister(SPIDriver *spip, uint8_t reg) {

+

+  spiSelect(spip);

+  txbuf[0] = 0x80 | reg;

+  txbuf[1] = 0xff;

+  spiExchange(spip, 2, txbuf, rxbuf);

+  spiUnselect(spip);

+  return rxbuf[1];

+}

+

+/**

+ * @brief   Writes a value into a register.

+ * @pre     The SPI interface must be initialized and the driver started.

+ *

+ * @param[in] spip      pointer to the SPI initerface

+ * @param[in] reg       register number

+ * @param[in] value     the value to be written

+ */

+void lis302dlWriteRegister(SPIDriver *spip, uint8_t reg, uint8_t value) {

+

+  switch (reg) {

+  default:

+    /* Reserved register must not be written, according to the datasheet

+       this could permanently damage the device.*/

+    chDbgAssert(FALSE, "lis302dlWriteRegister(), #1", "reserved register");

+  case LIS302DL_WHO_AM_I:

+  case LIS302DL_HP_FILTER_RESET:

+  case LIS302DL_STATUS_REG:

+  case LIS302DL_OUTX:

+  case LIS302DL_OUTY:

+  case LIS302DL_OUTZ:

+  case LIS302DL_FF_WU_SRC1:

+  case LIS302DL_FF_WU_SRC2:

+  case LIS302DL_CLICK_SRC:

+    /* Read only registers cannot be written, the command is ignored.*/

+    return;

+  case LIS302DL_CTRL_REG1:

+  case LIS302DL_CTRL_REG2:

+  case LIS302DL_CTRL_REG3:

+  case LIS302DL_FF_WU_CFG1:

+  case LIS302DL_FF_WU_THS1:

+  case LIS302DL_FF_WU_DURATION1:

+  case LIS302DL_FF_WU_CFG2:

+  case LIS302DL_FF_WU_THS2:

+  case LIS302DL_FF_WU_DURATION2:

+  case LIS302DL_CLICK_CFG:

+  case LIS302DL_CLICK_THSY_X:

+  case LIS302DL_CLICK_THSZ:

+  case LIS302DL_CLICK_TIMELIMIT:

+  case LIS302DL_CLICK_LATENCY:

+  case LIS302DL_CLICK_WINDOW:

+    spiSelect(spip);

+    txbuf[0] = reg;

+    txbuf[1] = value;

+    spiSend(spip, 2, txbuf);

+    spiUnselect(spip);

+  }

+}

+

+/** @} */

diff --git a/os/various/lis302dl.h b/os/various/lis302dl.h
new file mode 100644
index 000000000..4e6fefaaa
--- /dev/null
+++ b/os/various/lis302dl.h
@@ -0,0 +1,73 @@
+/*

+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,

+                 2011 Giovanni Di Sirio.

+

+    This file is part of ChibiOS/RT.

+

+    ChibiOS/RT is free software; you can redistribute it and/or modify

+    it under the terms of the GNU General Public License as published by

+    the Free Software Foundation; either version 3 of the License, or

+    (at your option) any later version.

+

+    ChibiOS/RT is distributed in the hope that it will be useful,

+    but WITHOUT ANY WARRANTY; without even the implied warranty of

+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

+    GNU General Public License for more details.

+

+    You should have received a copy of the GNU General Public License

+    along with this program.  If not, see <http://www.gnu.org/licenses/>.

+*/

+

+/**

+ * @file    lis302dl.h

+ * @brief   LIS302DL MEMS interface module through SPI header.

+ *

+ * @addtogroup lis302dl

+ * @{

+ */

+

+#ifndef _LIS302DL_H_

+#define _LIS302DL_H_

+

+/**

+ * @name    LIS302DL register names

+ * @{

+ */

+#define LIS302DL_WHO_AM_I               0x0F

+#define LIS302DL_CTRL_REG1              0x20

+#define LIS302DL_CTRL_REG2              0x21

+#define LIS302DL_CTRL_REG3              0x22

+#define LIS302DL_HP_FILTER_RESET        0x23

+#define LIS302DL_STATUS_REG             0x27

+#define LIS302DL_OUTX                   0x29

+#define LIS302DL_OUTY                   0x2B

+#define LIS302DL_OUTZ                   0x2D

+#define LIS302DL_FF_WU_CFG1             0x30

+#define LIS302DL_FF_WU_SRC1             0x31

+#define LIS302DL_FF_WU_THS1             0x32

+#define LIS302DL_FF_WU_DURATION1        0x33

+#define LIS302DL_FF_WU_CFG2             0x34

+#define LIS302DL_FF_WU_SRC2             0x35

+#define LIS302DL_FF_WU_THS2             0x36

+#define LIS302DL_FF_WU_DURATION2        0x37

+#define LIS302DL_CLICK_CFG              0x38

+#define LIS302DL_CLICK_SRC              0x39

+#define LIS302DL_CLICK_THSY_X           0x3B

+#define LIS302DL_CLICK_THSZ             0x3C

+#define LIS302DL_CLICK_TIMELIMIT        0x3D

+#define LIS302DL_CLICK_LATENCY          0x3E

+#define LIS302DL_CLICK_WINDOW           0x3F

+/** @} */

+

+#ifdef __cplusplus

+extern "C" {

+#endif

+  uint8_t lis302dlReadRegister(SPIDriver *spip, uint8_t reg);

+  void lis302dlWriteRegister(SPIDriver *spip, uint8_t reg, uint8_t value);

+#ifdef __cplusplus

+}

+#endif

+

+#endif /* _LIS302DL_H_ */

+

+/** @} */