久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標(biāo)題: 陀螺儀LIS3DH驅(qū)動程序 [打印本頁]
作者: wahyqf    時間: 2016-5-21 13:07
標(biāo)題: 陀螺儀LIS3DH驅(qū)動程序
分享一下lis3dh陀螺儀驅(qū)動例程，感興趣的同學(xué)們可以下來參考。
LIS3DH驅(qū)動程序，使用都可以根據(jù)例程來寫，只要再寫兩條程序就行了，在驅(qū)動程序中的讀與寫程序。
代碼下載：
陀螺儀LIS3DH驅(qū)動程序.zip (11.6 KB, 下載次數(shù): 449)


  2. /* Define to prevent recursive inclusion -------------------------------------*/
  3. #ifndef __LIS3DH_DRIVER__H
  4. #define __LIS3DH_DRIVER__H

  6. /* Includes ------------------------------------------------------------------*/
  7. /* Exported types ------------------------------------------------------------*/


  10. //these could change accordingly with the architecture

  12. #ifndef __ARCHDEP__TYPES
  13. #define __ARCHDEP__TYPES

  15. typedef unsigned char u8_t;
  16. typedef unsigned short int u16_t;
  17. typedef short int i16_t;
  18. typedef signed char i8_t;

  20. #endif /*__ARCHDEP__TYPES*/

  22. typedef u8_t LIS3DH_IntPinConf_t;
  23. typedef u8_t LIS3DH_Axis_t;
  24. typedef u8_t LIS3DH_Int1Conf_t;


  27. //define structure
  28. #ifndef __SHARED__TYPES
  29. #define __SHARED__TYPES

  31. typedef enum {
  32.   MEMS_SUCCESS                                =                0x01,
  33.   MEMS_ERROR                                =                0x00       
  34. } status_t;

  36. typedef enum {
  37.   MEMS_ENABLE                                =                0x01,
  38.   MEMS_DISABLE                                =                0x00       
  39. } State_t;

  41. typedef struct {
  42.   i16_t AXIS_X;
  43.   i16_t AXIS_Y;
  44.   i16_t AXIS_Z;
  45. } AxesRaw_t;

  47. #endif /*__SHARED__TYPES*/

  49. typedef enum {  
  50.   LIS3DH_ODR_1Hz                        =                0x01,               
  51.   LIS3DH_ODR_10Hz                      =                0x02,
  52.   LIS3DH_ODR_25Hz                        =                0x03,
  53.   LIS3DH_ODR_50Hz                        =                0x04,
  54.   LIS3DH_ODR_100Hz                        =                0x05,       
  55.   LIS3DH_ODR_200Hz                        =                0x06,
  56.   LIS3DH_ODR_400Hz                        =                0x07,
  57.   LIS3DH_ODR_1620Hz_LP                        =                0x08,
  58.   LIS3DH_ODR_1344Hz_NP_5367HZ_LP       =                0x09       
  59. } LIS3DH_ODR_t;

  61. typedef enum {
  62.   LIS3DH_POWER_DOWN                    =                0x00,
  63.   LIS3DH_LOW_POWER                         =                0x01,
  64.   LIS3DH_NORMAL                        =                0x02
  65. } LIS3DH_Mode_t;

  67. typedef enum {
  68.   LIS3DH_HPM_NORMAL_MODE_RES           =               0x00,
  69.   LIS3DH_HPM_REF_SIGNAL                =               0x01,
  70.   LIS3DH_HPM_NORMAL_MODE               =               0x02,
  71.   LIS3DH_HPM_AUTORESET_INT             =               0x03
  72. } LIS3DH_HPFMode_t;

  74. typedef enum {
  75.   LIS3DH_HPFCF_0                       =               0x00,
  76.   LIS3DH_HPFCF_1                       =               0x01,
  77.   LIS3DH_HPFCF_2                       =                 0x02,
  78.   LIS3DH_HPFCF_3                       =               0x03
  79. } LIS3DH_HPFCutOffFreq_t;

  81. typedef struct {
  82.   u16_t AUX_1;
  83.   u16_t AUX_2;
  84.   u16_t AUX_3;
  85. } LIS3DH_Aux123Raw_t;

  87. typedef enum {
  88.   LIS3DH_FULLSCALE_2                   =               0x00,
  89.   LIS3DH_FULLSCALE_4                   =               0x01,
  90.   LIS3DH_FULLSCALE_8                   =               0x02,
  91.   LIS3DH_FULLSCALE_16                  =               0x03
  92. } LIS3DH_Fullscale_t;

  94. typedef enum {
  95.   LIS3DH_BLE_LSB                        =                0x00,
  96.   LIS3DH_BLE_MSB                        =                0x01
  97. } LIS3DH_Endianess_t;

  99. typedef enum {
  100.   LIS3DH_SELF_TEST_DISABLE             =               0x00,
  101.   LIS3DH_SELF_TEST_0                   =               0x01,
  102.   LIS3DH_SELF_TEST_1                   =               0x02
  103. } LIS3DH_SelfTest_t;

  105. typedef enum {
  106.   LIS3DH_FIFO_BYPASS_MODE              =               0x00,
  107.   LIS3DH_FIFO_MODE                     =               0x01,
  108.   LIS3DH_FIFO_STREAM_MODE              =               0x02,
  109.   LIS3DH_FIFO_TRIGGER_MODE             =               0x03,
  110.   LIS3DH_FIFO_DISABLE                  =               0x04
  111. } LIS3DH_FifoMode_t;

  113. typedef enum {
  114.   LIS3DH_TRIG_INT1                     =                0x00,
  115.   LIS3DH_TRIG_INT2                         =                0x01
  116. } LIS3DH_TrigInt_t;

  118. typedef enum {
  119.   LIS3DH_SPI_4_WIRE                    =               0x00,
  120.   LIS3DH_SPI_3_WIRE                    =               0x01
  121. } LIS3DH_SPIMode_t;

  123. typedef enum {
  124.   LIS3DH_X_ENABLE                      =               0x01,
  125.   LIS3DH_X_DISABLE                     =               0x00,
  126.   LIS3DH_Y_ENABLE                      =               0x02,
  127.   LIS3DH_Y_DISABLE                     =               0x00,
  128.   LIS3DH_Z_ENABLE                      =               0x04,
  129.   LIS3DH_Z_DISABLE                     =               0x00   
  130. } LIS3DH_AXISenable_t;

  132. typedef enum {
  133.   LIS3DH_INT1_6D_4D_DISABLE            =               0x00,
  134.   LIS3DH_INT1_6D_ENABLE                =               0x01,
  135.   LIS3DH_INT1_4D_ENABLE                =               0x02
  136. } LIS3DH_INT_6D_4D_t;

  138. typedef enum {
  139.   LIS3DH_UP_SX                         =               0x44,
  140.   LIS3DH_UP_DX                         =               0x42,
  141.   LIS3DH_DW_SX                         =               0x41,
  142.   LIS3DH_DW_DX                         =               0x48,
  143.   LIS3DH_TOP                           =               0x60,
  144.   LIS3DH_BOTTOM                        =               0x50
  145. } LIS3DH_POSITION_6D_t;

  147. typedef enum {
  148.   LIS3DH_INT_MODE_OR                   =               0x00,
  149.   LIS3DH_INT_MODE_6D_MOVEMENT          =               0x01,
  150.   LIS3DH_INT_MODE_AND                  =               0x02,
  151.   LIS3DH_INT_MODE_6D_POSITION          =               0x03  
  152. } LIS3DH_Int1Mode_t;


  155. //interrupt click response
  156. //  b7 = don't care   b6 = IA  b5 = DClick  b4 = Sclick  b3 = Sign  
  157. //  b2 = z      b1 = y     b0 = x
  158. typedef enum {
  159. LIS3DH_DCLICK_Z_P                      =               0x24,
  160. LIS3DH_DCLICK_Z_N                      =               0x2C,
  161. LIS3DH_SCLICK_Z_P                      =               0x14,
  162. LIS3DH_SCLICK_Z_N                      =               0x1C,
  163. LIS3DH_DCLICK_Y_P                      =               0x22,
  164. LIS3DH_DCLICK_Y_N                      =               0x2A,
  165. LIS3DH_SCLICK_Y_P                      =               0x12,
  166. LIS3DH_SCLICK_Y_N                        =                0x1A,
  167. LIS3DH_DCLICK_X_P                      =               0x21,
  168. LIS3DH_DCLICK_X_N                      =               0x29,
  169. LIS3DH_SCLICK_X_P                      =               0x11,
  170. LIS3DH_SCLICK_X_N                      =               0x19,
  171. LIS3DH_NO_CLICK                        =               0x00
  172. } LIS3DH_Click_Response;

  174. //TODO: start from here and manage the shared macros etc before this

  176. /* Exported constants --------------------------------------------------------*/

  178. #ifndef __SHARED__CONSTANTS
  179. #define __SHARED__CONSTANTS

  181. #define MEMS_SET                                        0x01
  182. #define MEMS_RESET                                      0x00

  184. #endif /*__SHARED__CONSTANTS*/


  187. //Register Definition
  188. #define LIS3DH_WHO_AM_I                                0x0F  // device identification register

  190. // CONTROL REGISTER 1
  191. #define LIS3DH_CTRL_REG1                                0x20
  192. #define LIS3DH_ODR_BIT                                        BIT(4)
  193. #define LIS3DH_LPEN                                        BIT(3)
  194. #define LIS3DH_ZEN                                        BIT(2)
  195. #define LIS3DH_YEN                                        BIT(1)
  196. #define LIS3DH_XEN                                        BIT(0)

  198. //CONTROL REGISTER 2
  199. #define LIS3DH_CTRL_REG2                                0x21
  200. #define LIS3DH_HPM                                     BIT(6)
  201. #define LIS3DH_HPCF                                        BIT(4)
  202. #define LIS3DH_FDS                                        BIT(3)
  203. #define LIS3DH_HPCLICK                                        BIT(2)
  204. #define LIS3DH_HPIS2                                        BIT(1)
  205. #define LIS3DH_HPIS1                                        BIT(0)

  207. //CONTROL REGISTER 3
  208. #define LIS3DH_CTRL_REG3                                0x22
  209. #define LIS3DH_I1_CLICK                                BIT(7)
  210. #define LIS3DH_I1_AOI1                                        BIT(6)
  211. #define LIS3DH_I1_AOI2                                        BIT(5)
  212. #define LIS3DH_I1_DRDY1                                BIT(4)
  213. #define LIS3DH_I1_DRDY2                                BIT(3)
  214. #define LIS3DH_I1_WTM                                        BIT(2)
  215. #define LIS3DH_I1_ORUN                                        BIT(1)

  217. //CONTROL REGISTER 6
  218. #define LIS3DH_CTRL_REG6                                0x25
  219. #define LIS3DH_I2_CLICK                                BIT(7)
  220. #define LIS3DH_I2_INT1                                        BIT(6)
  221. #define LIS3DH_I2_BOOT                                 BIT(4)
  222. #define LIS3DH_H_LACTIVE                                BIT(1)

  224. //TEMPERATURE CONFIG REGISTER
  225. #define LIS3DH_TEMP_CFG_REG                                0x1F
  226. #define LIS3DH_ADC_PD                                        BIT(7)
  227. #define LIS3DH_TEMP_EN                                        BIT(6)

  229. //CONTROL REGISTER 4
  230. #define LIS3DH_CTRL_REG4                                0x23
  231. #define LIS3DH_BDU                                        BIT(7)
  232. #define LIS3DH_BLE                                        BIT(6)
  233. #define LIS3DH_FS                                        BIT(4)
  234. #define LIS3DH_HR                                        BIT(3)
  235. #define LIS3DH_ST                                       BIT(1)
  236. #define LIS3DH_SIM                                        BIT(0)

  238. //CONTROL REGISTER 5
  239. #define LIS3DH_CTRL_REG5                                0x24
  240. #define LIS3DH_BOOT                                    BIT(7)
  241. #define LIS3DH_FIFO_EN                                 BIT(6)
  242. #define LIS3DH_LIR_INT1                                BIT(3)
  243. #define LIS3DH_D4D_INT1                                BIT(2)

  245. //REFERENCE/DATA_CAPTURE
  246. #define LIS3DH_REFERENCE_REG                                0x26
  247. #define LIS3DH_REF                                        BIT(0)

  249. //STATUS_REG_AXIES
  250. #define LIS3DH_STATUS_REG                                0x27
  251. #define LIS3DH_ZYXOR                                   BIT(7)
  252. #define LIS3DH_ZOR                                     BIT(6)
  253. #define LIS3DH_YOR                                     BIT(5)
  254. #define LIS3DH_XOR                                     BIT(4)
  255. #define LIS3DH_ZYXDA                                   BIT(3)
  256. #define LIS3DH_ZDA                                     BIT(2)
  257. #define LIS3DH_YDA                                     BIT(1)
  258. #define LIS3DH_XDA                                     BIT(0)

  260. //STATUS_REG_AUX
  261. #define LIS3DH_STATUS_AUX                                0x07

  263. //INTERRUPT 1 CONFIGURATION
  264. #define LIS3DH_INT1_CFG                                0x30
  265. #define LIS3DH_ANDOR                                   BIT(7)
  266. #define LIS3DH_INT_6D                                  BIT(6)
  267. #define LIS3DH_ZHIE                                    BIT(5)
  268. #define LIS3DH_ZLIE                                    BIT(4)
  269. #define LIS3DH_YHIE                                    BIT(3)
  270. #define LIS3DH_YLIE                                    BIT(2)
  271. #define LIS3DH_XHIE                                    BIT(1)
  272. #define LIS3DH_XLIE                                    BIT(0)

  274. //FIFO CONTROL REGISTER
  275. #define LIS3DH_FIFO_CTRL_REG                           0x2E
  276. #define LIS3DH_FM                                      BIT(6)
  277. #define LIS3DH_TR                                      BIT(5)
  278. #define LIS3DH_FTH                                     BIT(0)

  280. //CONTROL REG3 bit mask
  281. #define LIS3DH_CLICK_ON_PIN_INT1_ENABLE                0x80
  282. #define LIS3DH_CLICK_ON_PIN_INT1_DISABLE               0x00
  283. #define LIS3DH_I1_INT1_ON_PIN_INT1_ENABLE              0x40
  284. #define LIS3DH_I1_INT1_ON_PIN_INT1_DISABLE             0x00
  285. #define LIS3DH_I1_INT2_ON_PIN_INT1_ENABLE              0x20
  286. #define LIS3DH_I1_INT2_ON_PIN_INT1_DISABLE             0x00
  287. #define LIS3DH_I1_DRDY1_ON_INT1_ENABLE                 0x10
  288. #define LIS3DH_I1_DRDY1_ON_INT1_DISABLE                0x00
  289. #define LIS3DH_I1_DRDY2_ON_INT1_ENABLE                 0x08
  290. #define LIS3DH_I1_DRDY2_ON_INT1_DISABLE                0x00
  291. #define LIS3DH_WTM_ON_INT1_ENABLE                      0x04
  292. #define LIS3DH_WTM_ON_INT1_DISABLE                     0x00
  293. #define LIS3DH_INT1_OVERRUN_ENABLE                     0x02
  294. #define LIS3DH_INT1_OVERRUN_DISABLE                    0x00

  296. //CONTROL REG6 bit mask
  297. #define LIS3DH_CLICK_ON_PIN_INT2_ENABLE                0x80
  298. #define LIS3DH_CLICK_ON_PIN_INT2_DISABLE               0x00
  299. #define LIS3DH_I2_INT1_ON_PIN_INT2_ENABLE              0x40
  300. #define LIS3DH_I2_INT1_ON_PIN_INT2_DISABLE             0x00
  301. #define LIS3DH_I2_INT2_ON_PIN_INT2_ENABLE              0x20
  302. #define LIS3DH_I2_INT2_ON_PIN_INT2_DISABLE             0x00
  303. #define LIS3DH_I2_BOOT_ON_INT2_ENABLE                  0x10
  304. #define LIS3DH_I2_BOOT_ON_INT2_DISABLE                 0x00
  305. #define LIS3DH_INT_ACTIVE_HIGH                         0x00
  306. #define LIS3DH_INT_ACTIVE_LOW                          0x02

  308. //INT1_CFG bit mask
  309. #define LIS3DH_INT1_AND                                0x80
  310. #define LIS3DH_INT1_OR                                 0x00
  311. #define LIS3DH_INT1_ZHIE_ENABLE                        0x20
  312. #define LIS3DH_INT1_ZHIE_DISABLE                       0x00
  313. #define LIS3DH_INT1_ZLIE_ENABLE                        0x10
  314. #define LIS3DH_INT1_ZLIE_DISABLE                       0x00
  315. #define LIS3DH_INT1_YHIE_ENABLE                        0x08
  316. #define LIS3DH_INT1_YHIE_DISABLE                       0x00
  317. #define LIS3DH_INT1_YLIE_ENABLE                        0x04
  318. #define LIS3DH_INT1_YLIE_DISABLE                       0x00
  319. #define LIS3DH_INT1_XHIE_ENABLE                        0x02
  320. #define LIS3DH_INT1_XHIE_DISABLE                       0x00
  321. #define LIS3DH_INT1_XLIE_ENABLE                        0x01
  322. #define LIS3DH_INT1_XLIE_DISABLE                       0x00

  324. //INT1_SRC bit mask
  325. #define LIS3DH_INT1_SRC_IA                             0x40
  326. #define LIS3DH_INT1_SRC_ZH                             0x20
  327. #define LIS3DH_INT1_SRC_ZL                             0x10
  328. #define LIS3DH_INT1_SRC_YH                             0x08
  329. #define LIS3DH_INT1_SRC_YL                             0x04
  330. #define LIS3DH_INT1_SRC_XH                             0x02
  331. #define LIS3DH_INT1_SRC_XL                             0x01

  333. //INT1 REGISTERS
  334. #define LIS3DH_INT1_THS                                0x32
  335. #define LIS3DH_INT1_DURATION                           0x33

  337. //INTERRUPT 1 SOURCE REGISTER
  338. #define LIS3DH_INT1_SRC                                0x31

  340. //FIFO Source Register bit Mask
  341. #define LIS3DH_FIFO_SRC_WTM                            0x80
  342. #define LIS3DH_FIFO_SRC_OVRUN                          0x40
  343. #define LIS3DH_FIFO_SRC_EMPTY                          0x20
  344.   
  345. //INTERRUPT CLICK REGISTER
  346. #define LIS3DH_CLICK_CFG                                0x38
  347. //INTERRUPT CLICK CONFIGURATION bit mask
  348. #define LIS3DH_ZD_ENABLE                               0x20
  349. #define LIS3DH_ZD_DISABLE                              0x00
  350. #define LIS3DH_ZS_ENABLE                               0x10
  351. #define LIS3DH_ZS_DISABLE                              0x00
  352. #define LIS3DH_YD_ENABLE                               0x08
  353. #define LIS3DH_YD_DISABLE                              0x00
  354. #define LIS3DH_YS_ENABLE                               0x04
  355. #define LIS3DH_YS_DISABLE                              0x00
  356. #define LIS3DH_XD_ENABLE                               0x02
  357. #define LIS3DH_XD_DISABLE                              0x00
  358. #define LIS3DH_XS_ENABLE                               0x01
  359. #define LIS3DH_XS_DISABLE                              0x00

  361. //INTERRUPT CLICK SOURCE REGISTER
  362. #define LIS3DH_CLICK_SRC                               0x39
  363. //INTERRUPT CLICK SOURCE REGISTER bit mask
  364. #define LIS3DH_IA                                      0x40
  365. #define LIS3DH_DCLICK                                  0x20
  366. #define LIS3DH_SCLICK                                  0x10
  367. #define LIS3DH_CLICK_SIGN                              0x08
  368. #define LIS3DH_CLICK_Z                                 0x04
  369. #define LIS3DH_CLICK_Y                                 0x02
  370. #define LIS3DH_CLICK_X                                 0x01

  372. //Click-click Register
  373. #define LIS3DH_CLICK_THS                               0x3A
  374. #define LIS3DH_TIME_LIMIT                              0x3B
  375. #define LIS3DH_TIME_LATENCY                            0x3C
  376. #define LIS3DH_TIME_WINDOW                             0x3D

  378. //OUTPUT REGISTER
  379. #define LIS3DH_OUT_X_L                                        0x28
  380. #define LIS3DH_OUT_X_H                                        0x29
  381. #define LIS3DH_OUT_Y_L                                        0x2A
  382. #define LIS3DH_OUT_Y_H                                        0x2B
  383. #define LIS3DH_OUT_Z_L                                        0x2C
  384. #define LIS3DH_OUT_Z_H                                        0x2D

  386. //AUX REGISTER
  387. #define LIS3DH_OUT_1_L                                        0x08
  388. #define LIS3DH_OUT_1_H                                        0x09
  389. #define LIS3DH_OUT_2_L                                        0x0A
  390. #define LIS3DH_OUT_2_H                                        0x0B
  391. #define LIS3DH_OUT_3_L                                        0x0C
  392. #define LIS3DH_OUT_3_H                                        0x0D

  394. //STATUS REGISTER bit mask
  395. #define LIS3DH_STATUS_REG_ZYXOR                        0x80    // 1        :        new data set has over written the previous one
  396.                                                         // 0        :        no overrun has occurred (default)       
  397. #define LIS3DH_STATUS_REG_ZOR                          0x40    // 0        :        no overrun has occurred (default)
  398.                                                         // 1        :        new Z-axis data has over written the previous one
  399. #define LIS3DH_STATUS_REG_YOR                          0x20    // 0        :        no overrun has occurred (default)
  400.                                                         // 1        :        new Y-axis data has over written the previous one
  401. #define LIS3DH_STATUS_REG_XOR                          0x10    // 0        :        no overrun has occurred (default)
  402.                                                         // 1        :        new X-axis data has over written the previous one
  403. #define LIS3DH_STATUS_REG_ZYXDA                        0x08    // 0        :        a new set of data is not yet avvious one
  404.                                                         // 1        :        a new set of data is available
  405. #define LIS3DH_STATUS_REG_ZDA                          0x04    // 0        :        a new data for the Z-Axis is not availvious one
  406.                                                         // 1        :        a new data for the Z-Axis is available
  407. #define LIS3DH_STATUS_REG_YDA                          0x02    // 0        :        a new data for the Y-Axis is not available
  408.                                                         // 1        :        a new data for the Y-Axis is available
  409. #define LIS3DH_STATUS_REG_XDA                          0x01    // 0        :        a new data for the X-Axis is not available

  411. #define LIS3DH_DATAREADY_BIT                           LIS3DH_STATUS_REG_ZYXDA


  414. //STATUS AUX REGISTER bit mask
  415. #define LIS3DH_STATUS_AUX_321OR                         0x80
  416. #define LIS3DH_STATUS_AUX_3OR                           0x40
  417. #define LIS3DH_STATUS_AUX_2OR                           0x20
  418. #define LIS3DH_STATUS_AUX_1OR                           0x10
  419. #define LIS3DH_STATUS_AUX_321DA                         0x08
  420. #define LIS3DH_STATUS_AUX_3DA                           0x04
  421. #define LIS3DH_STATUS_AUX_2DA                           0x02
  422. #define LIS3DH_STATUS_AUX_1DA                           0x01

  424. #define LIS3DH_MEMS_I2C_ADDRESS                                0x33

  426. //FIFO REGISTERS
  427. #define LIS3DH_FIFO_CTRL_REG                                0x2E
  428. #define LIS3DH_FIFO_SRC_REG                                0x2F


  431. /* Exported macro ------------------------------------------------------------*/

  433. #ifndef __SHARED__MACROS

  435. #define __SHARED__MACROS
  436. #define ValBit(VAR,Place)         (VAR & (1<<Place))
  437. #define BIT(x) ( (x) )

  439. #endif /*__SHARED__MACROS*/

  441. /* Exported functions --------------------------------------------------------*/
  442. //Sensor Configuration Functions
  443. status_t LIS3DH_SetODR(LIS3DH_ODR_t ov);
  444. status_t LIS3DH_SetMode(LIS3DH_Mode_t md);
  445. status_t LIS3DH_SetAxis(LIS3DH_Axis_t axis);
  446. status_t LIS3DH_SetFullScale(LIS3DH_Fullscale_t fs);
  447. status_t LIS3DH_SetBDU(State_t bdu);
  448. status_t LIS3DH_SetBLE(LIS3DH_Endianess_t ble);
  449. status_t LIS3DH_SetSelfTest(LIS3DH_SelfTest_t st);
  450. status_t LIS3DH_SetTemperature(State_t state);
  451. status_t LIS3DH_SetADCAux(State_t state);

  453. //Filtering Functions
  454. status_t LIS3DH_HPFClickEnable(State_t hpfe);
  455. status_t LIS3DH_HPFAOI1Enable(State_t hpfe);
  456. status_t LIS3DH_HPFAOI2Enable(State_t hpfe);
  457. status_t LIS3DH_SetHPFMode(LIS3DH_HPFMode_t hpf);
  458. status_t LIS3DH_SetHPFCutOFF(LIS3DH_HPFCutOffFreq_t hpf);
  459. status_t LIS3DH_SetFilterDataSel(State_t state);

  461. //Interrupt Functions
  462. status_t LIS3DH_SetInt1Pin(LIS3DH_IntPinConf_t pinConf);
  463. status_t LIS3DH_SetInt2Pin(LIS3DH_IntPinConf_t pinConf);
  464. status_t LIS3DH_Int1LatchEnable(State_t latch);
  465. status_t LIS3DH_ResetInt1Latch(void);
  466. status_t LIS3DH_SetIntConfiguration(LIS3DH_Int1Conf_t ic);
  467. status_t LIS3DH_SetInt1Threshold(u8_t ths);
  468. status_t LIS3DH_SetInt1Duration(LIS3DH_Int1Conf_t id);
  469. status_t LIS3DH_SetIntMode(LIS3DH_Int1Mode_t ic);
  470. status_t LIS3DH_SetClickCFG(u8_t status);
  471. status_t LIS3DH_SetInt6D4DConfiguration(LIS3DH_INT_6D_4D_t ic);
  472. status_t LIS3DH_GetInt1Src(u8_t* val);
  473. status_t LIS3DH_GetInt1SrcBit(u8_t statusBIT, u8_t* val);

  475. //FIFO Functions
  476. status_t LIS3DH_FIFOModeEnable(LIS3DH_FifoMode_t fm);
  477. status_t LIS3DH_SetWaterMark(u8_t wtm);
  478. status_t LIS3DH_SetTriggerInt(LIS3DH_TrigInt_t tr);
  479. status_t LIS3DH_GetFifoSourceReg(u8_t* val);
  480. status_t LIS3DH_GetFifoSourceBit(u8_t statusBIT, u8_t* val);
  481. status_t LIS3DH_GetFifoSourceFSS(u8_t* val);

  483. //Other Reading Functions
  484. status_t LIS3DH_GetStatusReg(u8_t* val);
  485. status_t LIS3DH_GetStatusBit(u8_t statusBIT, u8_t* val);
  486. status_t LIS3DH_GetStatusAUXBit(u8_t statusBIT, u8_t* val);
  487. status_t LIS3DH_GetStatusAUX(u8_t* val);
  488. status_t LIS3DH_GetAccAxesRaw(AxesRaw_t* buff);
  489. status_t LIS3DH_GetAuxRaw(LIS3DH_Aux123Raw_t* buff);
  490. status_t LIS3DH_GetClickResponse(u8_t* val);
  491. status_t LIS3DH_GetTempRaw(i8_t* val);
  492. status_t LIS3DH_GetWHO_AM_I(u8_t* val);
  493. status_t LIS3DH_Get6DPosition(u8_t* val);

  495. //Generic
  496. // i.e. u8_t LIS3DH_ReadReg(u8_t Reg, u8_t* Data);
  497. // i.e. u8_t LIS3DH_WriteReg(u8_t Reg, u8_t Data);


  500. #endif /* __LIS3DH_H */

  502. /******************* (C) COPYRIGHT 2012 STMicroelectronics *****END OF FILE****/



  506. 2、陀螺儀LIS3DH驅(qū)動程序的.c文件

  508. LIS3DH_driver.c
  509. /******************** (C) COPYRIGHT 2012 STMicroelectronics ********************
  510. * File Name          : LIS3DH_driver.c
  511. * Author             : MSH Application Team
  512. * Author             : Fabio Tota
  513. * Version            : $Revision:$
  514. * Date               : $Date:$
  515. * Description        : LIS3DH driver file
  516. *                     
  517. * HISTORY:
  518. * Date               |        Modification                    |        Author
  519. * 24/06/2011         |        Initial Revision                |        Fabio Tota
  520. * 11/06/2012         |        Support for multiple drivers in the same program |        Abhishek Anand

  522. ********************************************************************************
  523. * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
  524. * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
  525. * AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
  526. * INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
  527. * CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
  528. * INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
  529. *
  530. * THIS SOFTWARE IS SPECIFICALLY DESIGNED FOR EXCLUSIVE USE WITH ST PARTS.
  531. *
  532. *******************************************************************************/

  534. /* Includes ------------------------------------------------------------------*/
  535. #include "lis3dh_driver.h"
  536. /* Private typedef -----------------------------------------------------------*/
  537. /* Private define ------------------------------------------------------------*/
  538. /* Private macro -------------------------------------------------------------*/
  539. /* Private variables ---------------------------------------------------------*/
  540. /* Private function prototypes -----------------------------------------------*/

  542. /*******************************************************************************
  543. * Function Name                : LIS3DH_ReadReg
  544. * Description                : Generic Reading function. It must be fullfilled with either
  545. *                        : I2C or SPI reading functions                                       
  546. * Input                        : Register Address
  547. * Output                : Data REad
  548. * Return                : None
  549. *******************************************************************************/
  550. u8_t LIS3DH_ReadReg(u8_t Reg, u8_t* Data) {
  551.   
  552.   //To be completed with either I2c or SPI reading function
  553.   //i.e. *Data = SPI_Mems_Read_Reg( Reg );  
  554.   return 1;
  555. }


  558. /*******************************************************************************
  559. * Function Name                : LIS3DH_WriteReg
  560. * Description                : Generic Writing function. It must be fullfilled with either
  561. *                        : I2C or SPI writing function
  562. * Input                        : Register Address, Data to be written
  563. * Output                : None
  564. * Return                : None
  565. *******************************************************************************/
  566. u8_t LIS3DH_WriteReg(u8_t WriteAddr, u8_t Data) {
  567.   
  568.   //To be completed with either I2c or SPI writing function
  569.   //i.e. SPI_Mems_Write_Reg(WriteAddr, Data);  
  570.   return 1;
  571. }


  574. /* Private functions ---------------------------------------------------------*/

  576. /*******************************************************************************
  577. * Function Name  : LIS3DH_GetWHO_AM_I
  578. * Description    : Read identification code by WHO_AM_I register
  579. * Input          : Char to empty by Device identification Value
  580. * Output         : None
  581. * Return         : Status [value of FSS]
  582. *******************************************************************************/
  583. status_t LIS3DH_GetWHO_AM_I(u8_t* val){
  584.   
  585.   if( !LIS3DH_ReadReg(LIS3DH_WHO_AM_I, val) )
  586.     return MEMS_ERROR;
  587.   
  588.   return MEMS_SUCCESS;
  589. }


  592. /*******************************************************************************
  593. * Function Name  : LIS3DH_GetStatusAUX
  594. * Description    : Read the AUX status register
  595. * Input          : Char to empty by status register buffer
  596. * Output         : None
  597. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  598. *******************************************************************************/
  599. status_t LIS3DH_GetStatusAUX(u8_t* val) {
  600.   
  601.   if( !LIS3DH_ReadReg(LIS3DH_STATUS_AUX, val) )
  602.     return MEMS_ERROR;
  603.   
  604.   return MEMS_SUCCESS;  
  605. }



  609. /*******************************************************************************
  610. * Function Name  : LIS3DH_GetStatusAUXBIT
  611. * Description    : Read the AUX status register BIT
  612. * Input          : LIS3DH_STATUS_AUX_321OR, LIS3DH_STATUS_AUX_3OR, LIS3DH_STATUS_AUX_2OR, LIS3DH_STATUS_AUX_1OR,
  613.                    LIS3DH_STATUS_AUX_321DA, LIS3DH_STATUS_AUX_3DA, LIS3DH_STATUS_AUX_2DA, LIS3DH_STATUS_AUX_1DA
  614. * Output         : None
  615. * Return         : Status of BIT [MEMS_ERROR, MEMS_SUCCESS]
  616. *******************************************************************************/
  617. status_t LIS3DH_GetStatusAUXBit(u8_t statusBIT, u8_t* val) {
  618.   u8_t value;  
  619.   
  620.   if( !LIS3DH_ReadReg(LIS3DH_STATUS_AUX, &value) )
  621.     return MEMS_ERROR;
  622.   
  623.   if(statusBIT == LIS3DH_STATUS_AUX_321OR){
  624.     if(value &= LIS3DH_STATUS_AUX_321OR){     
  625.       *val = MEMS_SET;
  626.       return MEMS_SUCCESS;
  627.     }
  628.     else{  
  629.       *val = MEMS_RESET;
  630.       return MEMS_SUCCESS;
  631.     }   
  632.   }
  633.   
  634.   if(statusBIT == LIS3DH_STATUS_AUX_3OR){
  635.     if(value &= LIS3DH_STATUS_AUX_3OR){     
  636.       *val = MEMS_SET;
  637.       return MEMS_SUCCESS;
  638.     }
  639.     else{  
  640.       *val = MEMS_RESET;
  641.       return MEMS_SUCCESS;
  642.     }     
  643.   }
  644.   
  645.   if(statusBIT == LIS3DH_STATUS_AUX_2OR){
  646.     if(value &= LIS3DH_STATUS_AUX_2OR){     
  647.       *val = MEMS_SET;
  648.       return MEMS_SUCCESS;
  649.     }
  650.     else{  
  651.       *val = MEMS_RESET;
  652.       return MEMS_SUCCESS;
  653.     }   
  654.   }
  655.   
  656.   if(statusBIT == LIS3DH_STATUS_AUX_1OR){
  657.     if(value &= LIS3DH_STATUS_AUX_1OR){     
  658.       *val = MEMS_SET;
  659.       return MEMS_SUCCESS;
  660.     }
  661.     else{  
  662.       *val = MEMS_RESET;
  663.       return MEMS_SUCCESS;
  664.     }   
  665.   }
  666.   
  667.   if(statusBIT == LIS3DH_STATUS_AUX_321DA){
  668.     if(value &= LIS3DH_STATUS_AUX_321DA) {     
  669.       *val = MEMS_SET;
  670.       return MEMS_SUCCESS;
  671.     }
  672.     else{  
  673.       *val = MEMS_RESET;
  674.       return MEMS_SUCCESS;
  675.     }   
  676.   }
  677.   
  678.   if(statusBIT == LIS3DH_STATUS_AUX_3DA){
  679.     if(value &= LIS3DH_STATUS_AUX_3DA){     
  680.       *val = MEMS_SET;
  681.       return MEMS_SUCCESS;
  682.     }
  683.     else{  
  684.       *val = MEMS_RESET;
  685.       return MEMS_SUCCESS;
  686.     }   
  687.   }
  688.   
  689.   if(statusBIT == LIS3DH_STATUS_AUX_2DA){
  690.     if(value &= LIS3DH_STATUS_AUX_2DA){     
  691.       *val = MEMS_SET;
  692.       return MEMS_SUCCESS;
  693.     }
  694.     else{  
  695.       *val = MEMS_RESET;
  696.       return MEMS_SUCCESS;
  697.     }  
  698.   }
  699.   
  700.   if(statusBIT == LIS3DH_STATUS_AUX_1DA){
  701.     if(value &= LIS3DH_STATUS_AUX_1DA){     
  702.       *val = MEMS_SET;
  703.       return MEMS_SUCCESS;
  704.     }
  705.     else{  
  706.       *val = MEMS_RESET;
  707.       return MEMS_SUCCESS;
  708.     }  
  709.   }  
  710.   return MEMS_ERROR;
  711. }


  714. /*******************************************************************************
  715. * Function Name  : LIS3DH_SetODR
  716. * Description    : Sets LIS3DH Output Data Rate
  717. * Input          : Output Data Rate
  718. * Output         : None
  719. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  720. *******************************************************************************/
  721. status_t LIS3DH_SetODR(LIS3DH_ODR_t ov){
  722.   u8_t value;
  723.   
  724.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG1, &value) )
  725.     return MEMS_ERROR;
  726.   
  727.   value &= 0x0f;
  728.   value |= ov<<LIS3DH_ODR_BIT;
  729.   
  730.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG1, value) )
  731.     return MEMS_ERROR;
  732.   
  733.   return MEMS_SUCCESS;
  734. }


  737. /*******************************************************************************
  738. * Function Name  : LIS3DH_SetTemperature
  739. * Description    : Sets LIS3DH Output Temperature
  740. * Input          : MEMS_ENABLE, MEMS_DISABLE
  741. * Output         : None
  742. * Note           : For Read Temperature by LIS3DH_OUT_AUX_3, LIS3DH_SetADCAux and LIS3DH_SetBDU
  743.                                    functions must be ENABLE
  744. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  745. *******************************************************************************/
  746. status_t LIS3DH_SetTemperature(State_t state){
  747.   u8_t value;
  748.   
  749.   if( !LIS3DH_ReadReg(LIS3DH_TEMP_CFG_REG, &value) )
  750.     return MEMS_ERROR;
  751.   
  752.   value &= 0xBF;
  753.   value |= state<<LIS3DH_TEMP_EN;
  754.   
  755.   if( !LIS3DH_WriteReg(LIS3DH_TEMP_CFG_REG, value) )
  756.     return MEMS_ERROR;
  757.   
  758.   return MEMS_SUCCESS;
  759. }


  762. /*******************************************************************************
  763. * Function Name  : LIS3DH_SetADCAux
  764. * Description    : Sets LIS3DH Output ADC
  765. * Input          : MEMS_ENABLE, MEMS_DISABLE
  766. * Output         : None
  767. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  768. *******************************************************************************/
  769. status_t LIS3DH_SetADCAux(State_t state){
  770.   u8_t value;
  771.   
  772.   if( !LIS3DH_ReadReg(LIS3DH_TEMP_CFG_REG, &value) )
  773.     return MEMS_ERROR;
  774.   
  775.   value &= 0x7F;
  776.   value |= state<<LIS3DH_ADC_PD;
  777.   
  778.   if( !LIS3DH_WriteReg(LIS3DH_TEMP_CFG_REG, value) )
  779.     return MEMS_ERROR;
  780.   
  781.   return MEMS_SUCCESS;
  782. }


  785. /*******************************************************************************
  786. * Function Name  : LIS3DH_GetAuxRaw
  787. * Description    : Read the Aux Values Output Registers
  788. * Input          : Buffer to empty
  789. * Output         : Aux Values Registers buffer
  790. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  791. *******************************************************************************/
  792. status_t LIS3DH_GetAuxRaw(LIS3DH_Aux123Raw_t* buff) {
  793.   u8_t valueL;
  794.   u8_t valueH;
  795.   
  796.   if( !LIS3DH_ReadReg(LIS3DH_OUT_1_L, &valueL) )
  797.     return MEMS_ERROR;
  798.   
  799.   if( !LIS3DH_ReadReg(LIS3DH_OUT_1_H, &valueH) )
  800.     return MEMS_ERROR;
  801.   
  802.   buff->AUX_1 = (u16_t)( (valueH << 8) | valueL )/16;
  803.   
  804.   if( !LIS3DH_ReadReg(LIS3DH_OUT_2_L, &valueL) )
  805.     return MEMS_ERROR;
  806.   
  807.   if( !LIS3DH_ReadReg(LIS3DH_OUT_2_H, &valueH) )
  808.     return MEMS_ERROR;
  809.   
  810.   buff->AUX_2 = (u16_t)( (valueH << 8) | valueL )/16;
  811.   
  812.   if( !LIS3DH_ReadReg(LIS3DH_OUT_3_L, &valueL) )
  813.     return MEMS_ERROR;
  814.   
  815.   if( !LIS3DH_ReadReg(LIS3DH_OUT_3_H, &valueH) )
  816.     return MEMS_ERROR;
  817.   
  818.   buff->AUX_3 = (u16_t)( (valueH << 8) | valueL )/16;
  819.   
  820.   return MEMS_SUCCESS;  
  821. }


  824. /*******************************************************************************
  825. * Function Name  : LIS3DH_GetTempRaw
  826. * Description    : Read the Temperature Values by AUX Output Registers OUT_3_H
  827. * Input          : Buffer to empty
  828. * Output         : Temperature Values Registers buffer
  829. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  830. *******************************************************************************/
  831. status_t LIS3DH_GetTempRaw(i8_t* buff) {
  832.   u8_t valueL;
  833.   u8_t valueH;
  834.   
  835.   if( !LIS3DH_ReadReg(LIS3DH_OUT_3_L, &valueL) )
  836.     return MEMS_ERROR;
  837.   
  838.   if( !LIS3DH_ReadReg(LIS3DH_OUT_3_H, &valueH) )
  839.     return MEMS_ERROR;
  840.   
  841.   *buff = (i8_t)( valueH );
  842.   
  843.   return MEMS_SUCCESS;  
  844. }


  847. /*******************************************************************************
  848. * Function Name  : LIS3DH_SetMode
  849. * Description    : Sets LIS3DH Operating Mode
  850. * Input          : Modality (LIS3DH_NORMAL, LIS3DH_LOW_POWER, LIS3DH_POWER_DOWN)
  851. * Output         : None
  852. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  853. *******************************************************************************/
  854. status_t LIS3DH_SetMode(LIS3DH_Mode_t md) {
  855.   u8_t value;
  856.   u8_t value2;
  857.   static   u8_t ODR_old_value;
  858.   
  859.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG1, &value) )
  860.     return MEMS_ERROR;
  861.   
  862.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG4, &value2) )
  863.     return MEMS_ERROR;
  864.   
  865.   if((value & 0xF0)==0)
  866.     value = value | (ODR_old_value & 0xF0); //if it comes from POWERDOWN  
  867.   
  868.   switch(md) {
  869.    
  870.   case LIS3DH_POWER_DOWN:
  871.     ODR_old_value = value;
  872.     value &= 0x0F;
  873.     break;
  874.    
  875.   case LIS3DH_NORMAL:
  876.     value &= 0xF7;
  877.     value |= (MEMS_RESET<<LIS3DH_LPEN);
  878.     value2 &= 0xF7;
  879.     value2 |= (MEMS_SET<<LIS3DH_HR);   //set HighResolution_BIT
  880.     break;
  881.    
  882.   case LIS3DH_LOW_POWER:               
  883.     value &= 0xF7;
  884.     value |=  (MEMS_SET<<LIS3DH_LPEN);
  885.     value2 &= 0xF7;
  886.     value2 |= (MEMS_RESET<<LIS3DH_HR); //reset HighResolution_BIT
  887.     break;
  888.    
  889.   default:
  890.     return MEMS_ERROR;
  891.   }
  892.   
  893.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG1, value) )
  894.     return MEMS_ERROR;
  895.   
  896.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG4, value2) )
  897.     return MEMS_ERROR;  
  898.   
  899.   return MEMS_SUCCESS;
  900. }


  903. /*******************************************************************************
  904. * Function Name  : LIS3DH_SetAxis
  905. * Description    : Enable/Disable LIS3DH Axis
  906. * Input          : LIS3DH_X_ENABLE/DISABLE | LIS3DH_Y_ENABLE/DISABLE | LIS3DH_Z_ENABLE/DISABLE
  907. * Output         : None
  908. * Note           : You MUST use all input variable in the argument, as example
  909. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  910. *******************************************************************************/
  911. status_t LIS3DH_SetAxis(LIS3DH_Axis_t axis) {
  912.   u8_t value;
  913.   
  914.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG1, &value) )
  915.     return MEMS_ERROR;
  916.   value &= 0xF8;
  917.   value |= (0x07 & axis);
  918.   
  919.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG1, value) )
  920.     return MEMS_ERROR;   
  921.   
  922.   return MEMS_SUCCESS;
  923. }


  926. /*******************************************************************************
  927. * Function Name  : LIS3DH_SetFullScale
  928. * Description    : Sets the LIS3DH FullScale
  929. * Input          : LIS3DH_FULLSCALE_2/LIS3DH_FULLSCALE_4/LIS3DH_FULLSCALE_8/LIS3DH_FULLSCALE_16
  930. * Output         : None
  931. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  932. *******************************************************************************/
  933. status_t LIS3DH_SetFullScale(LIS3DH_Fullscale_t fs) {
  934.   u8_t value;
  935.   
  936.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG4, &value) )
  937.     return MEMS_ERROR;
  938.   
  939.   value &= 0xCF;       
  940.   value |= (fs<<LIS3DH_FS);
  941.   
  942.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG4, value) )
  943.     return MEMS_ERROR;
  944.   
  945.   return MEMS_SUCCESS;
  946. }


  949. /*******************************************************************************
  950. * Function Name  : LIS3DH_SetBDU
  951. * Description    : Enable/Disable Block Data Update Functionality
  952. * Input          : ENABLE/DISABLE
  953. * Output         : None
  954. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  955. *******************************************************************************/
  956. status_t LIS3DH_SetBDU(State_t bdu) {
  957.   u8_t value;
  958.   
  959.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG4, &value) )
  960.     return MEMS_ERROR;
  961.   
  962.   value &= 0x7F;
  963.   value |= (bdu<<LIS3DH_BDU);
  964.   
  965.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG4, value) )
  966.     return MEMS_ERROR;
  967.   
  968.   return MEMS_SUCCESS;
  969. }


  972. /*******************************************************************************
  973. * Function Name  : LIS3DH_SetBLE
  974. * Description    : Set Endianess (MSB/LSB)
  975. * Input          : BLE_LSB / BLE_MSB
  976. * Output         : None
  977. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  978. *******************************************************************************/
  979. status_t LIS3DH_SetBLE(LIS3DH_Endianess_t ble) {
  980.   u8_t value;
  981.   
  982.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG4, &value) )
  983.     return MEMS_ERROR;
  984.   
  985.   value &= 0xBF;       
  986.   value |= (ble<<LIS3DH_BLE);
  987.   
  988.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG4, value) )
  989.     return MEMS_ERROR;
  990.   
  991.   return MEMS_SUCCESS;
  992. }


  995. /*******************************************************************************
  996. * Function Name  : LIS3DH_SetSelfTest
  997. * Description    : Set Self Test Modality
  998. * Input          : LIS3DH_SELF_TEST_DISABLE/ST_0/ST_1
  999. * Output         : None
  1000. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1001. *******************************************************************************/
  1002. status_t LIS3DH_SetSelfTest(LIS3DH_SelfTest_t st) {
  1003.   u8_t value;
  1004.   
  1005.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG4, &value) )
  1006.     return MEMS_ERROR;
  1007.   
  1008.   value &= 0xF9;
  1009.   value |= (st<<LIS3DH_ST);
  1010.   
  1011.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG4, value) )
  1012.     return MEMS_ERROR;
  1013.   
  1014.   return MEMS_SUCCESS;
  1015. }


  1018. /*******************************************************************************
  1019. * Function Name  : LIS3DH_HPFClick
  1020. * Description    : Enable/Disable High Pass Filter for click
  1021. * Input          : MEMS_ENABLE/MEMS_DISABLE
  1022. * Output         : None
  1023. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1024. *******************************************************************************/
  1025. status_t LIS3DH_HPFClickEnable(State_t hpfe) {
  1026.   u8_t value;
  1027.   
  1028.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG2, &value) )
  1029.     return MEMS_ERROR;
  1030.   
  1031.   value &= 0xFB;
  1032.   value |= (hpfe<<LIS3DH_HPCLICK);
  1033.   
  1034.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG2, value) )
  1035.     return MEMS_ERROR;
  1036.   
  1037.   return MEMS_SUCCESS;
  1038. }


  1041. /*******************************************************************************
  1042. * Function Name  : LIS3DH_HPFAOI1
  1043. * Description    : Enable/Disable High Pass Filter for AOI on INT_1
  1044. * Input          : MEMS_ENABLE/MEMS_DISABLE
  1045. * Output         : None
  1046. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1047. *******************************************************************************/
  1048. status_t LIS3DH_HPFAOI1Enable(State_t hpfe) {
  1049.   u8_t value;
  1050.   
  1051.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG2, &value) )
  1052.     return MEMS_ERROR;
  1053.   
  1054.   value &= 0xFE;
  1055.   value |= (hpfe<<LIS3DH_HPIS1);
  1056.   
  1057.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG2, value) )
  1058.     return MEMS_ERROR;
  1059.   
  1060.   return MEMS_SUCCESS;
  1061. }


  1064. /*******************************************************************************
  1065. * Function Name  : LIS3DH_HPFAOI2
  1066. * Description    : Enable/Disable High Pass Filter for AOI on INT_2
  1067. * Input          : MEMS_ENABLE/MEMS_DISABLE
  1068. * Output         : None
  1069. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1070. *******************************************************************************/
  1071. status_t LIS3DH_HPFAOI2Enable(State_t hpfe) {
  1072.   u8_t value;
  1073.   
  1074.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG2, &value) )
  1075.     return MEMS_ERROR;
  1076.   
  1077.   value &= 0xFD;
  1078.   value |= (hpfe<<LIS3DH_HPIS2);
  1079.   
  1080.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG2, value) )
  1081.     return MEMS_ERROR;
  1082.   
  1083.   return MEMS_SUCCESS;
  1084. }


  1087. /*******************************************************************************
  1088. * Function Name  : LIS3DH_SetHPFMode
  1089. * Description    : Set High Pass Filter Modality
  1090. * Input          : LIS3DH_HPM_NORMAL_MODE_RES/LIS3DH_HPM_REF_SIGNAL/
  1091.                                    LIS3DH_HPM_NORMAL_MODE/LIS3DH_HPM_AUTORESET_INT
  1092. * Output         : None
  1093. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1094. *******************************************************************************/
  1095. status_t LIS3DH_SetHPFMode(LIS3DH_HPFMode_t hpm) {
  1096.   u8_t value;
  1097.   
  1098.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG2, &value) )
  1099.     return MEMS_ERROR;
  1100.   
  1101.   value &= 0x3F;
  1102.   value |= (hpm<<LIS3DH_HPM);
  1103.   
  1104.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG2, value) )
  1105.     return MEMS_ERROR;
  1106.   
  1107.   return MEMS_SUCCESS;
  1108. }


  1111. /*******************************************************************************
  1112. * Function Name  : LIS3DH_SetHPFCutOFF
  1113. * Description    : Set High Pass CUT OFF Freq
  1114. * Input          : HPFCF [0,3]
  1115. * Output         : None
  1116. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1117. *******************************************************************************/
  1118. status_t LIS3DH_SetHPFCutOFF(LIS3DH_HPFCutOffFreq_t hpf) {
  1119.   u8_t value;
  1120.   
  1121.   if (hpf > 3)
  1122.     return MEMS_ERROR;
  1123.   
  1124.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG2, &value) )
  1125.     return MEMS_ERROR;
  1126.   
  1127.   value &= 0xCF;
  1128.   value |= (hpf<<LIS3DH_HPCF);
  1129.   
  1130.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG2, value) )
  1131.     return MEMS_ERROR;
  1132.   
  1133.   return MEMS_SUCCESS;
  1134.   
  1135. }


  1138. /*******************************************************************************
  1139. * Function Name  : LIS3DH_SetFilterDataSel
  1140. * Description    : Set Filter Data Selection bypassed or sent to FIFO OUT register
  1141. * Input          : MEMS_SET, MEMS_RESET
  1142. * Output         : None
  1143. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1144. *******************************************************************************/
  1145. status_t LIS3DH_SetFilterDataSel(State_t state) {
  1146.   u8_t value;
  1147.   
  1148.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG2, &value) )
  1149.     return MEMS_ERROR;
  1150.   
  1151.   value &= 0xF7;
  1152.   value |= (state<<LIS3DH_FDS);
  1153.   
  1154.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG2, value) )
  1155.     return MEMS_ERROR;
  1156.   
  1157.   return MEMS_SUCCESS;
  1158.   
  1159. }


  1162. /*******************************************************************************
  1163. * Function Name  : LIS3DH_SetInt1Pin
  1164. * Description    : Set Interrupt1 pin Function
  1165. * Input          :  LIS3DH_CLICK_ON_PIN_INT1_ENABLE/DISABLE    | LIS3DH_I1_INT1_ON_PIN_INT1_ENABLE/DISABLE |              
  1166.                     LIS3DH_I1_INT2_ON_PIN_INT1_ENABLE/DISABLE  | LIS3DH_I1_DRDY1_ON_INT1_ENABLE/DISABLE    |              
  1167.                     LIS3DH_I1_DRDY2_ON_INT1_ENABLE/DISABLE     | LIS3DH_WTM_ON_INT1_ENABLE/DISABLE         |           
  1168.                     LIS3DH_INT1_OVERRUN_ENABLE/DISABLE  
  1169. * example        : SetInt1Pin(LIS3DH_CLICK_ON_PIN_INT1_ENABLE | LIS3DH_I1_INT1_ON_PIN_INT1_ENABLE |              
  1170.                     LIS3DH_I1_INT2_ON_PIN_INT1_DISABLE | LIS3DH_I1_DRDY1_ON_INT1_ENABLE | LIS3DH_I1_DRDY2_ON_INT1_ENABLE |
  1171.                     LIS3DH_WTM_ON_INT1_DISABLE | LIS3DH_INT1_OVERRUN_DISABLE   )
  1172. * Note           : To enable Interrupt signals on INT1 Pad (You MUST use all input variable in the argument, as example)
  1173. * Output         : None
  1174. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1175. *******************************************************************************/
  1176. status_t LIS3DH_SetInt1Pin(LIS3DH_IntPinConf_t pinConf) {
  1177.   u8_t value;
  1178.   
  1179.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG3, &value) )
  1180.     return MEMS_ERROR;
  1181.   
  1182.   value &= 0x00;
  1183.   value |= pinConf;
  1184.   
  1185.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG3, value) )
  1186.     return MEMS_ERROR;
  1187.   
  1188.   return MEMS_SUCCESS;
  1189. }


  1192. /*******************************************************************************
  1193. * Function Name  : LIS3DH_SetInt2Pin
  1194. * Description    : Set Interrupt2 pin Function
  1195. * Input          : LIS3DH_CLICK_ON_PIN_INT2_ENABLE/DISABLE   | LIS3DH_I2_INT1_ON_PIN_INT2_ENABLE/DISABLE |               
  1196.                    LIS3DH_I2_INT2_ON_PIN_INT2_ENABLE/DISABLE | LIS3DH_I2_BOOT_ON_INT2_ENABLE/DISABLE |                  
  1197.                    LIS3DH_INT_ACTIVE_HIGH/LOW
  1198. * example        : LIS3DH_SetInt2Pin(LIS3DH_CLICK_ON_PIN_INT2_ENABLE/DISABLE | LIS3DH_I2_INT1_ON_PIN_INT2_ENABLE/DISABLE |               
  1199.                    LIS3DH_I2_INT2_ON_PIN_INT2_ENABLE/DISABLE | LIS3DH_I2_BOOT_ON_INT2_ENABLE/DISABLE |                  
  1200.                    LIS3DH_INT_ACTIVE_HIGH/LOW)
  1201. * Note           : To enable Interrupt signals on INT2 Pad (You MUST use all input variable in the argument, as example)
  1202. * Output         : None
  1203. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1204. *******************************************************************************/
  1205. status_t LIS3DH_SetInt2Pin(LIS3DH_IntPinConf_t pinConf) {
  1206.   u8_t value;
  1207.   
  1208.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG6, &value) )
  1209.     return MEMS_ERROR;
  1210.   
  1211.   value &= 0x00;
  1212.   value |= pinConf;
  1213.   
  1214.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG6, value) )
  1215.     return MEMS_ERROR;
  1216.   
  1217.   return MEMS_SUCCESS;
  1218. }                       


  1221. /*******************************************************************************
  1222. * Function Name  : LIS3DH_SetClickCFG
  1223. * Description    : Set Click Interrupt config Function
  1224. * Input          : LIS3DH_ZD_ENABLE/DISABLE | LIS3DH_ZS_ENABLE/DISABLE  | LIS3DH_YD_ENABLE/DISABLE  |
  1225.                    LIS3DH_YS_ENABLE/DISABLE | LIS3DH_XD_ENABLE/DISABLE  | LIS3DH_XS_ENABLE/DISABLE
  1226. * example        : LIS3DH_SetClickCFG( LIS3DH_ZD_ENABLE | LIS3DH_ZS_DISABLE | LIS3DH_YD_ENABLE |
  1227.                                LIS3DH_YS_DISABLE | LIS3DH_XD_ENABLE | LIS3DH_XS_ENABLE)
  1228. * Note           : You MUST use all input variable in the argument, as example
  1229. * Output         : None
  1230. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1231. *******************************************************************************/
  1232. status_t LIS3DH_SetClickCFG(u8_t status) {
  1233.   u8_t value;
  1234.   
  1235.   if( !LIS3DH_ReadReg(LIS3DH_CLICK_CFG, &value) )
  1236.     return MEMS_ERROR;
  1237.   
  1238.   value &= 0xC0;
  1239.   value |= status;
  1240.   
  1241.   if( !LIS3DH_WriteReg(LIS3DH_CLICK_CFG, value) )
  1242.     return MEMS_ERROR;
  1243.   
  1244.   return MEMS_SUCCESS;
  1245. }  


  1248. /*******************************************************************************
  1249. * Function Name  : LIS3DH_SetClickTHS
  1250. * Description    : Set Click Interrupt threshold
  1251. * Input          : Click-click Threshold value [0-127]
  1252. * Output         : None
  1253. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1254. *******************************************************************************/
  1255. status_t LIS3DH_SetClickTHS(u8_t ths) {
  1256.   
  1257.   if(ths>127)     
  1258.     return MEMS_ERROR;
  1259.   
  1260.   if( !LIS3DH_WriteReg(LIS3DH_CLICK_THS, ths) )
  1261.     return MEMS_ERROR;
  1262.   
  1263.   return MEMS_SUCCESS;
  1264. }


  1267. /*******************************************************************************
  1268. * Function Name  : LIS3DH_SetClickLIMIT
  1269. * Description    : Set Click Interrupt Time Limit
  1270. * Input          : Click-click Time Limit value [0-127]
  1271. * Output         : None
  1272. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1273. *******************************************************************************/
  1274. status_t LIS3DH_SetClickLIMIT(u8_t t_limit) {
  1275.   
  1276.   if(t_limit>127)     
  1277.     return MEMS_ERROR;
  1278.   
  1279.   if( !LIS3DH_WriteReg(LIS3DH_TIME_LIMIT, t_limit) )
  1280.     return MEMS_ERROR;
  1281.   
  1282.   return MEMS_SUCCESS;
  1283. }


  1286. /*******************************************************************************
  1287. * Function Name  : LIS3DH_SetClickLATENCY
  1288. * Description    : Set Click Interrupt Time Latency
  1289. * Input          : Click-click Time Latency value [0-255]
  1290. * Output         : None
  1291. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1292. *******************************************************************************/
  1293. status_t LIS3DH_SetClickLATENCY(u8_t t_latency) {
  1294.   
  1295.   if( !LIS3DH_WriteReg(LIS3DH_TIME_LATENCY, t_latency) )
  1296.     return MEMS_ERROR;
  1297.   
  1298.   return MEMS_SUCCESS;
  1299. }


  1302. /*******************************************************************************
  1303. * Function Name  : LIS3DH_SetClickWINDOW
  1304. * Description    : Set Click Interrupt Time Window
  1305. * Input          : Click-click Time Window value [0-255]
  1306. * Output         : None
  1307. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1308. *******************************************************************************/
  1309. status_t LIS3DH_SetClickWINDOW(u8_t t_window) {
  1310.   
  1311.   if( !LIS3DH_WriteReg(LIS3DH_TIME_WINDOW, t_window) )
  1312.     return MEMS_ERROR;
  1313.   
  1314.   return MEMS_SUCCESS;
  1315. }


  1318. /*******************************************************************************
  1319. * Function Name  : LIS3DH_GetClickResponse
  1320. * Description    : Get Click Interrupt Response by CLICK_SRC REGISTER
  1321. * Input          : char to empty by Click Response Typedef
  1322. * Output         : None
  1323. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1324. *******************************************************************************/
  1325. status_t LIS3DH_GetClickResponse(u8_t* res) {
  1326.   u8_t value;
  1327.   
  1328.   if( !LIS3DH_ReadReg(LIS3DH_CLICK_SRC, &value) )
  1329.     return MEMS_ERROR;
  1330.   
  1331.   value &= 0x7F;
  1332.   
  1333.   if((value & LIS3DH_IA)==0) {        
  1334.     *res = LIS3DH_NO_CLICK;     
  1335.     return MEMS_SUCCESS;
  1336.   }
  1337.   else {
  1338.     if (value & LIS3DH_DCLICK){
  1339.       if (value & LIS3DH_CLICK_SIGN){
  1340.         if (value & LIS3DH_CLICK_Z) {
  1341.           *res = LIS3DH_DCLICK_Z_N;   
  1342.           return MEMS_SUCCESS;
  1343.         }
  1344.         if (value & LIS3DH_CLICK_Y) {
  1345.           *res = LIS3DH_DCLICK_Y_N;   
  1346.           return MEMS_SUCCESS;
  1347.         }
  1348.         if (value & LIS3DH_CLICK_X) {
  1349.           *res = LIS3DH_DCLICK_X_N;   
  1350.           return MEMS_SUCCESS;
  1351.         }
  1352.       }
  1353.       else{
  1354.         if (value & LIS3DH_CLICK_Z) {
  1355.           *res = LIS3DH_DCLICK_Z_P;   
  1356.           return MEMS_SUCCESS;
  1357.         }
  1358.         if (value & LIS3DH_CLICK_Y) {
  1359.           *res = LIS3DH_DCLICK_Y_P;   
  1360.           return MEMS_SUCCESS;
  1361.         }
  1362.         if (value & LIS3DH_CLICK_X) {
  1363.           *res = LIS3DH_DCLICK_X_P;   
  1364.           return MEMS_SUCCESS;
  1365.         }
  1366.       }      
  1367.     }
  1368.     else{
  1369.       if (value & LIS3DH_CLICK_SIGN){
  1370.         if (value & LIS3DH_CLICK_Z) {
  1371.           *res = LIS3DH_SCLICK_Z_N;   
  1372.           return MEMS_SUCCESS;
  1373.         }
  1374.         if (value & LIS3DH_CLICK_Y) {
  1375.           *res = LIS3DH_SCLICK_Y_N;   
  1376.           return MEMS_SUCCESS;
  1377.         }
  1378.         if (value & LIS3DH_CLICK_X) {
  1379.           *res = LIS3DH_SCLICK_X_N;   
  1380.           return MEMS_SUCCESS;
  1381.         }
  1382.       }
  1383.       else{
  1384.         if (value & LIS3DH_CLICK_Z) {
  1385.           *res = LIS3DH_SCLICK_Z_P;   
  1386.           return MEMS_SUCCESS;
  1387.         }
  1388.         if (value & LIS3DH_CLICK_Y) {
  1389.           *res = LIS3DH_SCLICK_Y_P;   
  1390.           return MEMS_SUCCESS;
  1391.         }
  1392.         if (value & LIS3DH_CLICK_X) {
  1393.           *res = LIS3DH_SCLICK_X_P;   
  1394.           return MEMS_SUCCESS;
  1395.         }
  1396.       }
  1397.     }
  1398.   }
  1399.   return MEMS_ERROR;
  1400. }


  1403. /*******************************************************************************
  1404. * Function Name  : LIS3DH_Int1LatchEnable
  1405. * Description    : Enable Interrupt 1 Latching function
  1406. * Input          : ENABLE/DISABLE
  1407. * Output         : None
  1408. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1409. *******************************************************************************/
  1410. status_t LIS3DH_Int1LatchEnable(State_t latch) {
  1411.   u8_t value;
  1412.   
  1413.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value) )
  1414.     return MEMS_ERROR;
  1415.   
  1416.   value &= 0xF7;
  1417.   value |= latch<<LIS3DH_LIR_INT1;
  1418.   
  1419.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value) )
  1420.     return MEMS_ERROR;
  1421.   
  1422.   return MEMS_SUCCESS;
  1423. }


  1426. /*******************************************************************************
  1427. * Function Name  : LIS3DH_ResetInt1Latch
  1428. * Description    : Reset Interrupt 1 Latching function
  1429. * Input          : None
  1430. * Output         : None
  1431. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1432. *******************************************************************************/
  1433. status_t LIS3DH_ResetInt1Latch(void) {
  1434.   u8_t value;
  1435.   
  1436.   if( !LIS3DH_ReadReg(LIS3DH_INT1_SRC, &value) )
  1437.     return MEMS_ERROR;
  1438.   
  1439.   return MEMS_SUCCESS;
  1440. }


  1443. /*******************************************************************************
  1444. * Function Name  : LIS3DH_SetIntConfiguration
  1445. * Description    : Interrupt 1 Configuration (without LIS3DH_6D_INT)
  1446. * Input          : LIS3DH_INT1_AND/OR | LIS3DH_INT1_ZHIE_ENABLE/DISABLE | LIS3DH_INT1_ZLIE_ENABLE/DISABLE...
  1447. * Output         : None
  1448. * Note           : You MUST use all input variable in the argument, as example
  1449. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1450. *******************************************************************************/
  1451. status_t LIS3DH_SetIntConfiguration(LIS3DH_Int1Conf_t ic) {
  1452.   u8_t value;
  1453.   
  1454.   if( !LIS3DH_ReadReg(LIS3DH_INT1_CFG, &value) )
  1455.     return MEMS_ERROR;
  1456.   
  1457.   value &= 0x40;
  1458.   value |= ic;
  1459.   
  1460.   if( !LIS3DH_WriteReg(LIS3DH_INT1_CFG, value) )
  1461.     return MEMS_ERROR;
  1462.   
  1463.   return MEMS_SUCCESS;
  1464. }

  1466.      
  1467. /*******************************************************************************
  1468. * Function Name  : LIS3DH_SetIntMode
  1469. * Description    : Interrupt 1 Configuration mode (OR, 6D Movement, AND, 6D Position)
  1470. * Input          : LIS3DH_INT_MODE_OR, LIS3DH_INT_MODE_6D_MOVEMENT, LIS3DH_INT_MODE_AND,
  1471.                                    LIS3DH_INT_MODE_6D_POSITION
  1472. * Output         : None
  1473. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1474. *******************************************************************************/
  1475. status_t LIS3DH_SetIntMode(LIS3DH_Int1Mode_t int_mode) {
  1476.   u8_t value;
  1477.   
  1478.   if( !LIS3DH_ReadReg(LIS3DH_INT1_CFG, &value) )
  1479.     return MEMS_ERROR;
  1480.   
  1481.   value &= 0x3F;
  1482.   value |= (int_mode<<LIS3DH_INT_6D);
  1483.   
  1484.   if( !LIS3DH_WriteReg(LIS3DH_INT1_CFG, value) )
  1485.     return MEMS_ERROR;
  1486.   
  1487.   return MEMS_SUCCESS;
  1488. }

  1490.    
  1491. /*******************************************************************************
  1492. * Function Name  : LIS3DH_SetInt6D4DConfiguration
  1493. * Description    : 6D, 4D Interrupt Configuration
  1494. * Input          : LIS3DH_INT1_6D_ENABLE, LIS3DH_INT1_4D_ENABLE, LIS3DH_INT1_6D_4D_DISABLE
  1495. * Output         : None
  1496. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1497. *******************************************************************************/
  1498. status_t LIS3DH_SetInt6D4DConfiguration(LIS3DH_INT_6D_4D_t ic) {
  1499.   u8_t value;
  1500.   u8_t value2;
  1501.   
  1502.   if( !LIS3DH_ReadReg(LIS3DH_INT1_CFG, &value) )
  1503.     return MEMS_ERROR;
  1504.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value2) )
  1505.     return MEMS_ERROR;
  1506.   
  1507.   if(ic == LIS3DH_INT1_6D_ENABLE){
  1508.     value &= 0xBF;
  1509.     value |= (MEMS_ENABLE<<LIS3DH_INT_6D);
  1510.     value2 &= 0xFB;
  1511.     value2 |= (MEMS_DISABLE<<LIS3DH_D4D_INT1);
  1512.   }
  1513.   
  1514.   if(ic == LIS3DH_INT1_4D_ENABLE){
  1515.     value &= 0xBF;
  1516.     value |= (MEMS_ENABLE<<LIS3DH_INT_6D);
  1517.     value2 &= 0xFB;
  1518.     value2 |= (MEMS_ENABLE<<LIS3DH_D4D_INT1);
  1519.   }
  1520.   
  1521.   if(ic == LIS3DH_INT1_6D_4D_DISABLE){
  1522.     value &= 0xBF;
  1523.     value |= (MEMS_DISABLE<<LIS3DH_INT_6D);
  1524.     value2 &= 0xFB;
  1525.     value2 |= (MEMS_DISABLE<<LIS3DH_D4D_INT1);
  1526.   }
  1527.   
  1528.   if( !LIS3DH_WriteReg(LIS3DH_INT1_CFG, value) )
  1529.     return MEMS_ERROR;
  1530.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value2) )
  1531.     return MEMS_ERROR;
  1532.   
  1533.   return MEMS_SUCCESS;
  1534. }


  1537. /*******************************************************************************
  1538. * Function Name  : LIS3DH_Get6DPosition
  1539. * Description    : 6D, 4D Interrupt Position Detect
  1540. * Input          : Byte to empty by POSITION_6D_t Typedef
  1541. * Output         : None
  1542. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1543. *******************************************************************************/
  1544. status_t LIS3DH_Get6DPosition(u8_t* val){
  1545.   u8_t value;
  1546.   
  1547.   if( !LIS3DH_ReadReg(LIS3DH_INT1_SRC, &value) )
  1548.     return MEMS_ERROR;
  1549.   
  1550.   value &= 0x7F;
  1551.   
  1552.   switch (value){
  1553.   case LIS3DH_UP_SX:   
  1554.     *val = LIS3DH_UP_SX;   
  1555.     break;
  1556.   case LIS3DH_UP_DX:   
  1557.     *val = LIS3DH_UP_DX;   
  1558.     break;
  1559.   case LIS3DH_DW_SX:   
  1560.     *val = LIS3DH_DW_SX;   
  1561.     break;
  1562.   case LIS3DH_DW_DX:   
  1563.     *val = LIS3DH_DW_DX;   
  1564.     break;
  1565.   case LIS3DH_TOP:     
  1566.     *val = LIS3DH_TOP;      
  1567.     break;
  1568.   case LIS3DH_BOTTOM:  
  1569.     *val = LIS3DH_BOTTOM;   
  1570.     break;
  1571.   }
  1572.   
  1573.   return MEMS_SUCCESS;  
  1574. }


  1577. /*******************************************************************************
  1578. * Function Name  : LIS3DH_SetInt1Threshold
  1579. * Description    : Sets Interrupt 1 Threshold
  1580. * Input          : Threshold = [0,31]
  1581. * Output         : None
  1582. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1583. *******************************************************************************/
  1584. status_t LIS3DH_SetInt1Threshold(u8_t ths) {
  1585.   if (ths > 127)
  1586.     return MEMS_ERROR;
  1587.   
  1588.   if( !LIS3DH_WriteReg(LIS3DH_INT1_THS, ths) )
  1589.     return MEMS_ERROR;   
  1590.   
  1591.   return MEMS_SUCCESS;
  1592. }


  1595. /*******************************************************************************
  1596. * Function Name  : LIS3DH_SetInt1Duration
  1597. * Description    : Sets Interrupt 1 Duration
  1598. * Input          : Duration value
  1599. * Output         : None
  1600. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1601. *******************************************************************************/
  1602. status_t LIS3DH_SetInt1Duration(LIS3DH_Int1Conf_t id) {
  1603.   
  1604.   if (id > 127)
  1605.     return MEMS_ERROR;
  1606.   
  1607.   if( !LIS3DH_WriteReg(LIS3DH_INT1_DURATION, id) )
  1608.     return MEMS_ERROR;
  1609.   
  1610.   return MEMS_SUCCESS;
  1611. }


  1614. /*******************************************************************************
  1615. * Function Name  : LIS3DH_FIFOModeEnable
  1616. * Description    : Sets Fifo Modality
  1617. * Input          : LIS3DH_FIFO_DISABLE, LIS3DH_FIFO_BYPASS_MODE, LIS3DH_FIFO_MODE,
  1618.                                    LIS3DH_FIFO_STREAM_MODE, LIS3DH_FIFO_TRIGGER_MODE
  1619. * Output         : None
  1620. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1621. *******************************************************************************/
  1622. status_t LIS3DH_FIFOModeEnable(LIS3DH_FifoMode_t fm) {
  1623.   u8_t value;  
  1624.   
  1625.   if(fm == LIS3DH_FIFO_DISABLE) {
  1626.     if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1627.       return MEMS_ERROR;
  1628.    
  1629.     value &= 0x1F;
  1630.     value |= (LIS3DH_FIFO_BYPASS_MODE<<LIS3DH_FM);                     
  1631.    
  1632.     if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )           //fifo mode bypass
  1633.       return MEMS_ERROR;   
  1634.     if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value) )
  1635.       return MEMS_ERROR;
  1636.    
  1637.     value &= 0xBF;   
  1638.    
  1639.     if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value) )               //fifo disable
  1640.       return MEMS_ERROR;   
  1641.   }
  1642.   
  1643.   if(fm == LIS3DH_FIFO_BYPASS_MODE)   {  
  1644.     if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value) )
  1645.       return MEMS_ERROR;
  1646.    
  1647.     value &= 0xBF;
  1648.     value |= MEMS_SET<<LIS3DH_FIFO_EN;
  1649.    
  1650.     if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value) )               //fifo enable
  1651.       return MEMS_ERROR;  
  1652.     if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1653.       return MEMS_ERROR;
  1654.    
  1655.     value &= 0x1f;
  1656.     value |= (fm<<LIS3DH_FM);                     //fifo mode configuration
  1657.    
  1658.     if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )
  1659.       return MEMS_ERROR;
  1660.   }
  1661.   
  1662.   if(fm == LIS3DH_FIFO_MODE)   {
  1663.     if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value) )
  1664.       return MEMS_ERROR;
  1665.    
  1666.     value &= 0xBF;
  1667.     value |= MEMS_SET<<LIS3DH_FIFO_EN;
  1668.    
  1669.     if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value) )               //fifo enable
  1670.       return MEMS_ERROR;  
  1671.     if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1672.       return MEMS_ERROR;
  1673.    
  1674.     value &= 0x1f;
  1675.     value |= (fm<<LIS3DH_FM);                      //fifo mode configuration
  1676.    
  1677.     if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )
  1678.       return MEMS_ERROR;
  1679.   }
  1680.   
  1681.   if(fm == LIS3DH_FIFO_STREAM_MODE)   {  
  1682.     if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value) )
  1683.       return MEMS_ERROR;
  1684.    
  1685.     value &= 0xBF;
  1686.     value |= MEMS_SET<<LIS3DH_FIFO_EN;
  1687.    
  1688.     if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value) )               //fifo enable
  1689.       return MEMS_ERROR;   
  1690.     if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1691.       return MEMS_ERROR;
  1692.    
  1693.     value &= 0x1f;
  1694.     value |= (fm<<LIS3DH_FM);                      //fifo mode configuration
  1695.    
  1696.     if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )
  1697.       return MEMS_ERROR;
  1698.   }
  1699.   
  1700.   if(fm == LIS3DH_FIFO_TRIGGER_MODE)   {  
  1701.     if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG5, &value) )
  1702.       return MEMS_ERROR;
  1703.    
  1704.     value &= 0xBF;
  1705.     value |= MEMS_SET<<LIS3DH_FIFO_EN;
  1706.    
  1707.     if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG5, value) )               //fifo enable
  1708.       return MEMS_ERROR;   
  1709.     if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1710.       return MEMS_ERROR;
  1711.    
  1712.     value &= 0x1f;
  1713.     value |= (fm<<LIS3DH_FM);                      //fifo mode configuration
  1714.    
  1715.     if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )
  1716.       return MEMS_ERROR;
  1717.   }
  1718.   
  1719.   return MEMS_SUCCESS;
  1720. }


  1723. /*******************************************************************************
  1724. * Function Name  : LIS3DH_SetTriggerInt
  1725. * Description    : Trigger event liked to trigger signal INT1/INT2
  1726. * Input          : LIS3DH_TRIG_INT1/LIS3DH_TRIG_INT2
  1727. * Output         : None
  1728. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1729. *******************************************************************************/
  1730. status_t LIS3DH_SetTriggerInt(LIS3DH_TrigInt_t tr) {
  1731.   u8_t value;  
  1732.   
  1733.   if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1734.     return MEMS_ERROR;
  1735.   
  1736.   value &= 0xDF;
  1737.   value |= (tr<<LIS3DH_TR);
  1738.   
  1739.   if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )
  1740.     return MEMS_ERROR;
  1741.   
  1742.   return MEMS_SUCCESS;
  1743. }


  1746. /*******************************************************************************
  1747. * Function Name  : LIS3DH_SetWaterMark
  1748. * Description    : Sets Watermark Value
  1749. * Input          : Watermark = [0,31]
  1750. * Output         : None
  1751. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1752. *******************************************************************************/
  1753. status_t LIS3DH_SetWaterMark(u8_t wtm) {
  1754.   u8_t value;
  1755.   
  1756.   if(wtm > 31)
  1757.     return MEMS_ERROR;  
  1758.   
  1759.   if( !LIS3DH_ReadReg(LIS3DH_FIFO_CTRL_REG, &value) )
  1760.     return MEMS_ERROR;
  1761.   
  1762.   value &= 0xE0;
  1763.   value |= wtm;
  1764.   
  1765.   if( !LIS3DH_WriteReg(LIS3DH_FIFO_CTRL_REG, value) )
  1766.     return MEMS_ERROR;
  1767.   
  1768.   return MEMS_SUCCESS;
  1769. }

  1771.   
  1772. /*******************************************************************************
  1773. * Function Name  : LIS3DH_GetStatusReg
  1774. * Description    : Read the status register
  1775. * Input          : char to empty by Status Reg Value
  1776. * Output         : None
  1777. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1778. *******************************************************************************/
  1779. status_t LIS3DH_GetStatusReg(u8_t* val) {
  1780.   if( !LIS3DH_ReadReg(LIS3DH_STATUS_REG, val) )
  1781.     return MEMS_ERROR;
  1782.   
  1783.   return MEMS_SUCCESS;  
  1784. }


  1787. /*******************************************************************************
  1788. * Function Name  : LIS3DH_GetStatusBIT
  1789. * Description    : Read the status register BIT
  1790. * Input          : LIS3DH_STATUS_REG_ZYXOR, LIS3DH_STATUS_REG_ZOR, LIS3DH_STATUS_REG_YOR, LIS3DH_STATUS_REG_XOR,
  1791.                    LIS3DH_STATUS_REG_ZYXDA, LIS3DH_STATUS_REG_ZDA, LIS3DH_STATUS_REG_YDA, LIS3DH_STATUS_REG_XDA,
  1792.                                    LIS3DH_DATAREADY_BIT
  1793.                                    val: Byte to be filled with the status bit       
  1794. * Output         : status register BIT
  1795. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1796. *******************************************************************************/
  1797. status_t LIS3DH_GetStatusBit(u8_t statusBIT, u8_t* val) {
  1798.   u8_t value;  
  1799.   
  1800.   if( !LIS3DH_ReadReg(LIS3DH_STATUS_REG, &value) )
  1801.     return MEMS_ERROR;
  1802.   
  1803.   switch (statusBIT){
  1804.   case LIS3DH_STATUS_REG_ZYXOR:     
  1805.     if(value &= LIS3DH_STATUS_REG_ZYXOR){     
  1806.       *val = MEMS_SET;
  1807.       return MEMS_SUCCESS;
  1808.     }
  1809.     else{  
  1810.       *val = MEMS_RESET;
  1811.       return MEMS_SUCCESS;
  1812.     }  
  1813.   case LIS3DH_STATUS_REG_ZOR:      
  1814.     if(value &= LIS3DH_STATUS_REG_ZOR){     
  1815.       *val = MEMS_SET;
  1816.       return MEMS_SUCCESS;
  1817.     }
  1818.     else{  
  1819.       *val = MEMS_RESET;
  1820.       return MEMS_SUCCESS;
  1821.     }  
  1822.   case LIS3DH_STATUS_REG_YOR:      
  1823.     if(value &= LIS3DH_STATUS_REG_YOR){     
  1824.       *val = MEMS_SET;
  1825.       return MEMS_SUCCESS;
  1826.     }
  1827.     else{  
  1828.       *val = MEMS_RESET;
  1829.       return MEMS_SUCCESS;
  1830.     }                                 
  1831.   case LIS3DH_STATUS_REG_XOR:      
  1832.     if(value &= LIS3DH_STATUS_REG_XOR){     
  1833.       *val = MEMS_SET;
  1834.       return MEMS_SUCCESS;
  1835.     }
  1836.     else{  
  1837.       *val = MEMS_RESET;
  1838.       return MEMS_SUCCESS;
  1839.     }     
  1840.   case LIS3DH_STATUS_REG_ZYXDA:     
  1841.     if(value &= LIS3DH_STATUS_REG_ZYXDA){     
  1842.       *val = MEMS_SET;
  1843.       return MEMS_SUCCESS;
  1844.     }
  1845.     else{  
  1846.       *val = MEMS_RESET;
  1847.       return MEMS_SUCCESS;
  1848.     }   
  1849.   case LIS3DH_STATUS_REG_ZDA:      
  1850.     if(value &= LIS3DH_STATUS_REG_ZDA){     
  1851.       *val = MEMS_SET;
  1852.       return MEMS_SUCCESS;
  1853.     }
  1854.     else{  
  1855.       *val = MEMS_RESET;
  1856.       return MEMS_SUCCESS;
  1857.     }   
  1858.   case LIS3DH_STATUS_REG_YDA:      
  1859.     if(value &= LIS3DH_STATUS_REG_YDA){     
  1860.       *val = MEMS_SET;
  1861.       return MEMS_SUCCESS;
  1862.     }
  1863.     else{  
  1864.       *val = MEMS_RESET;
  1865.       return MEMS_SUCCESS;
  1866.     }   
  1867.   case LIS3DH_STATUS_REG_XDA:      
  1868.     if(value &= LIS3DH_STATUS_REG_XDA){     
  1869.       *val = MEMS_SET;
  1870.       return MEMS_SUCCESS;
  1871.     }
  1872.     else{  
  1873.       *val = MEMS_RESET;
  1874.       return MEMS_SUCCESS;
  1875.     }                                 
  1876.    
  1877.   }
  1878.   return MEMS_ERROR;
  1879. }


  1882. /*******************************************************************************
  1883. * Function Name  : LIS3DH_GetAccAxesRaw
  1884. * Description    : Read the Acceleration Values Output Registers
  1885. * Input          : buffer to empity by AxesRaw_t Typedef
  1886. * Output         : None
  1887. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1888. *******************************************************************************/
  1889. status_t LIS3DH_GetAccAxesRaw(AxesRaw_t* buff) {
  1890.   i16_t value;
  1891.   u8_t *valueL = (u8_t *)(&value);
  1892.   u8_t *valueH = ((u8_t *)(&value)+1);
  1893.   
  1894.   if( !LIS3DH_ReadReg(LIS3DH_OUT_X_L, valueL) )
  1895.     return MEMS_ERROR;
  1896.   
  1897.   if( !LIS3DH_ReadReg(LIS3DH_OUT_X_H, valueH) )
  1898.     return MEMS_ERROR;
  1899.   
  1900.   buff->AXIS_X = value;
  1901.   
  1902.   if( !LIS3DH_ReadReg(LIS3DH_OUT_Y_L, valueL) )
  1903.     return MEMS_ERROR;
  1904.   
  1905.   if( !LIS3DH_ReadReg(LIS3DH_OUT_Y_H, valueH) )
  1906.     return MEMS_ERROR;
  1907.   
  1908.   buff->AXIS_Y = value;
  1909.   
  1910.   if( !LIS3DH_ReadReg(LIS3DH_OUT_Z_L, valueL) )
  1911.     return MEMS_ERROR;
  1912.   
  1913.   if( !LIS3DH_ReadReg(LIS3DH_OUT_Z_H, valueH) )
  1914.     return MEMS_ERROR;
  1915.   
  1916.   buff->AXIS_Z = value;
  1917.   
  1918.   return MEMS_SUCCESS;
  1919. }


  1922. /*******************************************************************************
  1923. * Function Name  : LIS3DH_GetInt1Src
  1924. * Description    : Reset Interrupt 1 Latching function
  1925. * Input          : Char to empty by Int1 source value
  1926. * Output         : None
  1927. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  1928. *******************************************************************************/
  1929. status_t LIS3DH_GetInt1Src(u8_t* val) {
  1930.   
  1931.   if( !LIS3DH_ReadReg(LIS3DH_INT1_SRC, val) )
  1932.     return MEMS_ERROR;
  1933.   
  1934.   return MEMS_SUCCESS;
  1935. }


  1938. /*******************************************************************************
  1939. * Function Name  : LIS3DH_GetInt1SrcBit
  1940. * Description    : Reset Interrupt 1 Latching function
  1941. * Input          : statusBIT: LIS3DH_INT_SRC_IA, LIS3DH_INT_SRC_ZH, LIS3DH_INT_SRC_ZL.....
  1942. *                  val: Byte to be filled with the status bit
  1943. * Output         : None
  1944. * Return         : Status of BIT [MEMS_ERROR, MEMS_SUCCESS]
  1945. *******************************************************************************/
  1946. status_t LIS3DH_GetInt1SrcBit(u8_t statusBIT, u8_t* val) {
  1947.   u8_t value;  
  1948.    
  1949.   if( !LIS3DH_ReadReg(LIS3DH_INT1_SRC, &value) )
  1950.       return MEMS_ERROR;
  1951.    
  1952.   if(statusBIT == LIS3DH_INT1_SRC_IA){
  1953.     if(value &= LIS3DH_INT1_SRC_IA){     
  1954.       *val = MEMS_SET;
  1955.       return MEMS_SUCCESS;
  1956.     }
  1957.     else{  
  1958.       *val = MEMS_RESET;
  1959.       return MEMS_SUCCESS;
  1960.     }  
  1961.   }
  1962.   
  1963.   if(statusBIT == LIS3DH_INT1_SRC_ZH){
  1964.     if(value &= LIS3DH_INT1_SRC_ZH){     
  1965.       *val = MEMS_SET;
  1966.       return MEMS_SUCCESS;
  1967.     }
  1968.     else{  
  1969.       *val = MEMS_RESET;
  1970.       return MEMS_SUCCESS;
  1971.     }  
  1972.   }
  1973.   
  1974.   if(statusBIT == LIS3DH_INT1_SRC_ZL){
  1975.     if(value &= LIS3DH_INT1_SRC_ZL){     
  1976.       *val = MEMS_SET;
  1977.       return MEMS_SUCCESS;
  1978.     }
  1979.     else{  
  1980.       *val = MEMS_RESET;
  1981.       return MEMS_SUCCESS;
  1982.     }  
  1983.   }
  1984.   
  1985.   if(statusBIT == LIS3DH_INT1_SRC_YH){
  1986.     if(value &= LIS3DH_INT1_SRC_YH){     
  1987.       *val = MEMS_SET;
  1988.       return MEMS_SUCCESS;
  1989.     }
  1990.     else{  
  1991.       *val = MEMS_RESET;
  1992.       return MEMS_SUCCESS;
  1993.     }  
  1994.   }
  1995.   
  1996.   if(statusBIT == LIS3DH_INT1_SRC_YL){
  1997.     if(value &= LIS3DH_INT1_SRC_YL){     
  1998.       *val = MEMS_SET;
  1999.       return MEMS_SUCCESS;
  2000.     }
  2001.     else{  
  2002.       *val = MEMS_RESET;
  2003.       return MEMS_SUCCESS;
  2004.     }  
  2005.   }
  2006.   if(statusBIT == LIS3DH_INT1_SRC_XH){
  2007.     if(value &= LIS3DH_INT1_SRC_XH){     
  2008.       *val = MEMS_SET;
  2009.       return MEMS_SUCCESS;
  2010.     }
  2011.     else{  
  2012.       *val = MEMS_RESET;
  2013.       return MEMS_SUCCESS;
  2014.     }  
  2015.   }
  2016.   
  2017.   if(statusBIT == LIS3DH_INT1_SRC_XL){
  2018.     if(value &= LIS3DH_INT1_SRC_XL){     
  2019.       *val = MEMS_SET;
  2020.       return MEMS_SUCCESS;
  2021.     }
  2022.     else{  
  2023.       *val = MEMS_RESET;
  2024.       return MEMS_SUCCESS;
  2025.     }  
  2026.   }
  2027.   return MEMS_ERROR;
  2028. }


  2031. /*******************************************************************************
  2032. * Function Name  : LIS3DH_GetFifoSourceReg
  2033. * Description    : Read Fifo source Register
  2034. * Input          : Byte to empty by FIFO source register value
  2035. * Output         : None
  2036. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  2037. *******************************************************************************/
  2038. status_t LIS3DH_GetFifoSourceReg(u8_t* val) {
  2039.   
  2040.   if( !LIS3DH_ReadReg(LIS3DH_FIFO_SRC_REG, val) )
  2041.     return MEMS_ERROR;
  2042.   
  2043.   return MEMS_SUCCESS;
  2044. }


  2047. /*******************************************************************************
  2048. * Function Name  : LIS3DH_GetFifoSourceBit
  2049. * Description    : Read Fifo WaterMark source bit
  2050. * Input          : statusBIT: LIS3DH_FIFO_SRC_WTM, LIS3DH_FIFO_SRC_OVRUN, LIS3DH_FIFO_SRC_EMPTY
  2051. *                                   val: Byte to fill  with the bit value
  2052. * Output         : None
  2053. * Return         : Status of BIT [MEMS_ERROR, MEMS_SUCCESS]
  2054. *******************************************************************************/
  2055. status_t LIS3DH_GetFifoSourceBit(u8_t statusBIT,  u8_t* val){
  2056.   u8_t value;  
  2057.   
  2058.   if( !LIS3DH_ReadReg(LIS3DH_FIFO_SRC_REG, &value) )
  2059.     return MEMS_ERROR;
  2060.   
  2061.   
  2062.   if(statusBIT == LIS3DH_FIFO_SRC_WTM){
  2063.     if(value &= LIS3DH_FIFO_SRC_WTM){     
  2064.       *val = MEMS_SET;
  2065.       return MEMS_SUCCESS;
  2066.     }
  2067.     else{  
  2068.       *val = MEMS_RESET;
  2069.       return MEMS_SUCCESS;
  2070.     }  
  2071.   }
  2072.   
  2073.   if(statusBIT == LIS3DH_FIFO_SRC_OVRUN){
  2074.     if(value &= LIS3DH_FIFO_SRC_OVRUN){     
  2075.       *val = MEMS_SET;
  2076.       return MEMS_SUCCESS;
  2077.     }
  2078.     else{  
  2079.       *val = MEMS_RESET;
  2080.       return MEMS_SUCCESS;
  2081.     }  
  2082.   }
  2083.   if(statusBIT == LIS3DH_FIFO_SRC_EMPTY){
  2084.     if(value &= statusBIT == LIS3DH_FIFO_SRC_EMPTY){     
  2085.       *val = MEMS_SET;
  2086.       return MEMS_SUCCESS;
  2087.     }
  2088.     else{  
  2089.       *val = MEMS_RESET;
  2090.       return MEMS_SUCCESS;
  2091.     }  
  2092.   }
  2093.   return MEMS_ERROR;
  2094. }


  2097. /*******************************************************************************
  2098. * Function Name  : LIS3DH_GetFifoSourceFSS
  2099. * Description    : Read current number of unread samples stored in FIFO
  2100. * Input          : Byte to empty by FIFO unread sample value
  2101. * Output         : None
  2102. * Return         : Status [value of FSS]
  2103. *******************************************************************************/
  2104. status_t LIS3DH_GetFifoSourceFSS(u8_t* val){
  2105.   u8_t value;
  2106.   
  2107.   if( !LIS3DH_ReadReg(LIS3DH_FIFO_SRC_REG, &value) )
  2108.     return MEMS_ERROR;
  2109.   
  2110.   value &= 0x1F;
  2111.   
  2112.   *val = value;
  2113.   
  2114.   return MEMS_SUCCESS;
  2115. }

  2117.       
  2118. /*******************************************************************************
  2119. * Function Name  : LIS3DH_SetSPIInterface
  2120. * Description    : Set SPI mode: 3 Wire Interface OR 4 Wire Interface
  2121. * Input          : LIS3DH_SPI_3_WIRE, LIS3DH_SPI_4_WIRE
  2122. * Output         : None
  2123. * Return         : Status [MEMS_ERROR, MEMS_SUCCESS]
  2124. *******************************************************************************/
  2125. status_t LIS3DH_SetSPIInterface(LIS3DH_SPIMode_t spi) {
  2126.   u8_t value;
  2127.   
  2128.   if( !LIS3DH_ReadReg(LIS3DH_CTRL_REG4, &value) )
  2129.     return MEMS_ERROR;
  2130.   
  2131.   value &= 0xFE;
  2132.   value |= spi<<LIS3DH_SIM;
  2133.   
  2134.   if( !LIS3DH_WriteReg(LIS3DH_CTRL_REG4, value) )
  2135.     return MEMS_ERROR;
  2136.   
  2137.   return MEMS_SUCCESS;
  2138. }
  2139. /******************* (C) COPYRIGHT 2012 STMicroelectronics *****END OF FILE****/


  2142. 3、陀螺儀LIS3DH基于驅(qū)動的例子

  2144. example_main.c
  2145. /******************** (C) COPYRIGHT 2012 STMicroelectronics ********************
  2146. 4、* File Name          : example_main.c
  2147. 5、* Author             : MSH Application Team
  2148. 6、* Author             : Abhishek Anand,Fabio Tota
  2149. 7、* Revision           : $Revision: 1.5 $
  2150. 8、* Date               : $Date: 16/06/2011 12:19:08 $
  2151. 9、* Description        : Example main file for MKI109V1 board
  2152. 10、* HISTORY:
  2153. 11、* Date        | Modification                                | Author
  2154. 12、* 16/06/2011  | Initial Revision                            | Fabio Tota
  2155. 13、* 11/06/2012  |        Support for multiple drivers in the same program |        Abhishek Anand
  2156. 14、
  2157. 15、********************************************************************************
  2158. 16、* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
  2159. 17、* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
  2160. 18、* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
  2161. 19、* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
  2162. 20、* CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
  2163. 21、* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
  2164. 22、*
  2165. 23、* THIS SOFTWARE IS SPECIFICALLY DESIGNED FOR EXCLUSIVE USE WITH ST PARTS.
  2166. 24、*
  2167. 25、*******************************************************************************/
  2168. 26、
  2169. 27、
  2170. 28、/* Includes ------------------------------------------------------------------*/
  2171. 29、//include files for MKI109V1 board
  2172. 30、#include "stm32f10x.h"
  2173. 31、#include "usb_lib.h"
  2174. 32、#include "usb_desc.h"
  2175. 33、#include "hw_config.h"
  2176. 34、#include "usb_pwr.h"
  2177. 35、#include "led.h"
  2178. 36、#include "button.h"
  2179. 37、#include "adc_mems.h"
  2180. 38、#include "string.h"
  2181. 39、#include "spi_mems.h"
  2182. 40、#include <stdio.h>
  2183. 41、
  2184. 42、//include MEMS driver
  2185. 43、#include "lis3dh_driver.h"
  2186. 44、
  2187. 45、/* Private typedef -----------------------------------------------------------*/
  2188. 46、/* Private define ------------------------------------------------------------*/
  2189. 47、/* Private macro -------------------------------------------------------------*/
  2190. 48、/* Private variables ---------------------------------------------------------*/
  2191. 49、uint8_t response;
  2192. 50、uint8_t USBbuffer[64];
  2193. 51、
  2194. 52、/* Extern variables ----------------------------------------------------------*/
  2195. 53、/* Private function prototypes -----------------------------------------------*/
  2196. 54、/* Private functions ---------------------------------------------------------*/
  2197. 55、
  2198. 56、//define for example1 or example2
  2199. 57、//#define __EXAMPLE1__H
  2200. 58、#define __EXAMPLE2__H
  2201. 59、
  2202. 60、/*******************************************************************************
  2203. 61、* Function Name  : main.
  2204. 62、* Description    : Main routine.
  2205. 63、* Input          : None.
  2206. 64、* Output         : None.
  2207. 65、* Return         : None.
  2208. 66、*******************************************************************************/
  2209. 67、int main(void)
  2210. 68、{
  2211. 69、  uint8_t buffer[26];
  2212. 70、  uint8_t position=0, old_position=0;
  2213. 71、  AxesRaw_t data;
  2214. 72、  //Initialize your hardware here
  2215. 73、  
  2216. 74、  //function for MKI109V1 board
  2217. 75、  InitHardware();
  2218. 76、  SPI_Mems_Init();
  2219. 77、  
  2220. 78、  EKSTM32_LEDOff(LED1);
  2221. 79、  EKSTM32_LEDOff(LED2);
  2222. 80、  EKSTM32_LEDOff(LED3);   
  2223. 81、
  2224. 82、  //wait until the USB is ready (MKI109V1 board)
  2225. 83、  while(bDeviceState != CONFIGURED);
  2226. 84、
  2227. 85、  //Inizialize MEMS Sensor
  2228. 86、  //set ODR (turn ON device)
  2229. 87、  response = LIS3DH_SetODR(LIS3DH_ODR_100Hz);
  2230. 88、  if(response==1){
  2231. 89、        sprintf((char*)buffer,"\n\rSET_ODR_OK    \n\r\0");
  2232. 90、        USB_SIL_Write(EP1_IN, buffer, 19);
  2233. 91、        SetEPTxValid(ENDP1);
  2234. 92、  }
  2235. 93、  //set PowerMode
  2236. 94、  response = LIS3DH_SetMode(LIS3DH_NORMAL);
  2237. 95、  if(response==1){
  2238. 96、        sprintf((char*)buffer,"SET_MODE_OK     \n\r\0");
  2239. 97、        USB_SIL_Write(EP1_IN, buffer, 19);
  2240. 98、        SetEPTxValid(ENDP1);
  2241. 99、  }
  2242. 100、  //set Fullscale
  2243. 101、  response = LIS3DH_SetFullScale(LIS3DH_FULLSCALE_2);
  2244. 102、  if(response==1){
  2245. 103、        sprintf((char*)buffer,"SET_FULLSCALE_OK\n\r\0");
  2246. 104、        USB_SIL_Write(EP1_IN, buffer, 19);
  2247. 105、        SetEPTxValid(ENDP1);
  2248. 106、  }
  2249. 107、  //set axis Enable
  2250. 108、  response = LIS3DH_SetAxis(LIS3DH_X_ENABLE | LIS3DH_Y_ENABLE | LIS3DH_Z_ENABLE);
  2251. 109、  if(response==1){
  2252. 110、        sprintf((char*)buffer,"SET_AXIS_OK     \n\r\0");
  2253. 111、        USB_SIL_Write(EP1_IN, buffer, 19);
  2254. 112、        SetEPTxValid(ENDP1);
  2255. 113、  }
  2256. 114、
  2257. 115、  
  2258. 116、/*********************/  
  2259. 117、/******Example 1******/
  2260. 118、#ifdef __EXAMPLE1__H
  2261. 119、  while(1){
  2262. 120、  //get Acceleration Raw data  
  2263. 121、  response = LIS3DH_GetAccAxesRaw(&data);
  2264. 122、  if(response==1){
  2265. 123、    //print data values
  2266. 124、    //function for MKI109V1 board
  2267. 125、    EKSTM32_LEDToggle(LED1);
  2268. 126、    sprintf((char*)buffer, "X=%6d Y=%6d Z=%6d \r\n", data.AXIS_X, data.AXIS_Y, data.AXIS_Z);
  2269. 127、    USB_SIL_Write(EP1_IN, buffer, 29);
  2270. 128、    SetEPTxValid(ENDP1);  
  2271. 129、    old_position = position;
  2272. 130、  }
  2273. 131、 }
  2274. 132、#endif /* __EXAMPLE1__H  */
  2275. 133、
  2276. 134、
  2277. 135、/*********************/
  2278. 136、/******Example 2******/
  2279. 137、#ifdef __EXAMPLE2__H
  2280. 138、 //configure Mems Sensor
  2281. 139、 //set Interrupt Threshold
  2282. 140、 response = LIS3DH_SetInt1Threshold(20);
  2283. 141、 if(response==1){
  2284. 142、        sprintf((char*)buffer,"SET_THRESHOLD_OK\n\r\0");
  2285. 143、        USB_SIL_Write(EP1_IN, buffer, 19);
  2286. 144、        SetEPTxValid(ENDP1);
  2287. 145、  }
  2288. 146、 //set Interrupt configuration (all enabled)
  2289. 147、 response = LIS3DH_SetIntConfiguration(LIS3DH_INT1_ZHIE_ENABLE | LIS3DH_INT1_ZLIE_ENABLE |
  2290. 148、                                                                           LIS3DH_INT1_YHIE_ENABLE | LIS3DH_INT1_YLIE_ENABLE |
  2291. 149、                                                                           LIS3DH_INT1_XHIE_ENABLE | LIS3DH_INT1_XLIE_ENABLE );
  2292. 150、 if(response==1){
  2293. 151、        sprintf((char*)buffer,"SET_INT_CONF_OK \n\r\0");
  2294. 152、        USB_SIL_Write(EP1_IN, buffer, 19);
  2295. 153、        SetEPTxValid(ENDP1);
  2296. 154、  }
  2297. 155、 //set Interrupt Mode
  2298. 156、 response = LIS3DH_SetIntMode(LIS3DH_INT_MODE_6D_POSITION);
  2299. 157、 if(response==1){
  2300. 158、        sprintf((char*)buffer,"SET_INT_MODE    \n\r\0");
  2301. 159、        USB_SIL_Write(EP1_IN, buffer, 19);
  2302. 160、        SetEPTxValid(ENDP1);
  2303. 161、  }
  2304. 162、
  2305. 163、 while(1){
  2306. 164、  //get 6D Position
  2307. 165、  response = LIS3DH_Get6DPosition(&position);
  2308. 166、  if((response==1) && (old_position!=position)){
  2309. 167、    EKSTM32_LEDToggle(LED1);
  2310. 168、    switch (position){
  2311. 169、    case LIS3DH_UP_SX:   sprintf((char*)buffer,"\n\rposition = UP_SX  \n\r\0");   break;
  2312. 170、    case LIS3DH_UP_DX:   sprintf((char*)buffer,"\n\rposition = UP_DX  \n\r\0");   break;
  2313. 171、    case LIS3DH_DW_SX:   sprintf((char*)buffer,"\n\rposition = DW_SX  \n\r\0");   break;              
  2314. 172、    case LIS3DH_DW_DX:   sprintf((char*)buffer,"\n\rposition = DW_DX  \n\r\0");   break;
  2315. 173、    case LIS3DH_TOP:     sprintf((char*)buffer,"\n\rposition = TOP    \n\r\0");   break;
  2316. 174、    case LIS3DH_BOTTOM:  sprintf((char*)buffer,"\n\rposition = BOTTOM \n\r\0");   break;
  2317. 175、    default:      sprintf((char*)buffer,"\n\rposition = unknown\n\r\0");   break;
  2318. 176、    }
  2319. 177、  
  2320. 178、  //function for MKI109V1 board   
  2321. 179、  USB_SIL_Write(EP1_IN, buffer, 23);
  2322. 180、  SetEPTxValid(ENDP1);  
  2323. 181、  old_position = position;
  2324. 182、  }
  2325. 183、 }
  2326. 184、#endif /*__EXAMPLE2__H */
  2327. 185、
  2328. 186、} // end main
  2329. 187、
  2330. 188、
  2331. 189、#ifdef USE_FULL_ASSERT
  2332. 190、
  2333. 191、
  2334. 192、//function for MKI109V1 board
  2335. 193、/*******************************************************************************
  2336. 194、* Function Name  : assert_failed
  2337. 195、* Description    : Reports the name of the source file and the source line number
  2338. 196、*                  where the assert_param error has occurred.
  2339. 197、* Input          : - file: pointer to the source file name
  2340. 198、*                  - line: assert_param error line source number
  2341. 199、* Output         : None
  2342. 200、* Return         : None
  2343. 201、*******************************************************************************/
  2344. 202、void assert_failed(uint8_t* file, uint32_t line)
  2345. 203、{
  2346. 204、  /* User can add his own implementation to report the file name and line number,
  2347. 205、     ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  2348. 206、
  2349. 207、  /* Infinite loop */
  2350. 208、  while (1)
  2351. 209、  {}
  2352. 210、}
  2353. 211、#endif
  2354. 212、
  2355. 213、/******************* (C) COPYRIGHT 2012 STMicroelectronics *****END OF FILE****/
  2356. 214、



復(fù)制代碼


作者: lilao3    時間: 2016-9-14 23:40
感謝分享，學(xué)習(xí)一下
作者: yuanzuo    時間: 2016-9-27 14:23
感謝分享，非常需要這個~
作者: HZH110    時間: 2016-11-5 11:44
感謝分享，學(xué)習(xí)一下!
作者: qingyu    時間: 2016-11-14 16:59
誰有完整的工程 讓我借鑒一下 實在是有點不懂
作者: 2455321262    時間: 2016-11-17 11:50
不是很懂，和樓上一樣
作者: 朝夕一葉    時間: 2016-11-28 20:15
感謝分享，學(xué)習(xí)一下
作者: ysdx06010302    時間: 2017-3-6 16:39
謝謝樓主，正在學(xué)習(xí)這個芯片。
作者: ezk    時間: 2017-3-17 11:55
產(chǎn)品種類:        加速計       
制造商:        STMicroelectronics       
RoHS:        符合RoHS 詳細(xì)信息       
傳感器類型:        3-axis       
傳感軸:        X, Y, Z       
加速:        16 g       
靈敏度:        1 mg/digit to 12 mg/digit       
輸出類型:        Digital       
接口類型:        I2C, SPI       
分辨率:        16 bit       
電源電壓-最大:        3.6 VDC       
電源電壓-最小:        1.71 VDC       
工作電源電流:        6 uA to 11 uA       
封裝 / 箱體:        LGA-16       
最大工作溫度:        + 85 C       
最小工作溫度:        - 40 C       
商標(biāo):        STMicroelectronics       
高度:        1 mm       
長度:        3 mm       
安裝風(fēng)格:        SMD/SMT       
工作電源電壓:        2.5 V       
封裝:        Reel       
系列:        LIS3DH       
工廠包裝數(shù)量:        4000       
類型:        MEMS Nano Accelerometer       
寬度:        3 mm           ST 華南區(qū)芯片銷售工程：18926438962 王工
作者: int    時間: 2017-3-21 18:31
寫的很規(guī)范，謝謝分享。
作者: xilinxue    時間: 2017-4-13 20:13
很不錯，受教了
作者: l123    時間: 2017-5-17 18:53
// i.e. u8_t LIS3DH_ReadReg(u8_t Reg, u8_t* Data);
// i.e. u8_t LIS3DH_WriteReg(u8_t Reg, u8_t Data);
是寫入自帶的寄存器嗎？
作者: 共享IC    時間: 2017-6-6 17:22
樓主能不能給我傳一份啊
作者: 共享IC    時間: 2017-6-8 15:47
樓主這個驅(qū)動要是換成I2C方式，怎么弄
作者: chengfgc    時間: 2017-7-21 10:31
謝謝分享，學(xué)習(xí)下！！！
作者: wiefel    時間: 2017-9-5 16:43
非常感謝，正是我需要的，希望驅(qū)動好用
作者: fengxianglu    時間: 2017-12-25 14:32
謝謝群主人分享！正好需要！
作者: stepwalker    時間: 2017-12-25 16:44
謝謝，正是所需要的，幫了大忙啊！！
作者: vince2008    時間: 2018-1-5 11:24
正好需要，謝謝哦
作者: astankvai    時間: 2018-5-3 09:19
這個試了,INT1腳不輸出上升沿中斷,是不是我的硬件焊接有問題?
作者: hpcomlee    時間: 2018-5-4 07:25
謝謝分享，學(xué)習(xí)下...........................
作者: asianeast    時間: 2018-5-28 17:40
不錯  不錯   很實用
作者: r71825    時間: 2018-6-26 12:14
陀螺儀LIS3DH驅(qū)動程序
作者: r71825    時間: 2018-6-26 12:15
不錯  不錯   很實用
作者: TONG1994    時間: 2018-8-2 09:45
感謝分享，好不容易找到了。就是積分不夠
作者: topway111    時間: 2018-9-18 12:00
很給力！
作者: 淇少爺    時間: 2018-10-23 11:28
學(xué)習(xí)了，謝謝分享
作者: cfjkings    時間: 2019-3-25 14:42
學(xué)習(xí)了，謝謝分享
作者: cfjkings    時間: 2019-3-25 14:43
很難找到驅(qū)動程序，相當(dāng)可以
作者: zsaniu    時間: 2019-7-2 08:30
感謝分享，學(xué)習(xí)一下！
作者: mcukljy    時間: 2019-7-16 14:40
太好了，寫的不錯，找了好久 了
作者: alangada    時間: 2021-3-18 18:22
mark下，感謝樓主
作者: albert01    時間: 2021-4-23 09:59
感謝樓主分享，我在ST官網(wǎng)找了好久沒找到



歡迎光臨 (http://m.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 久久久国产精品入口麻豆 | 国产美女网站 | 久久久xxx | 欧美日韩高清在线一区 | 国产一区不卡 | 九九亚洲| 超碰人人插 | 精品国产91亚洲一区二区三区www | 在线免费视频一区 | 亚洲在线| 国产综合久久 | cao视频 | 日本欧美国产在线观看 | 午夜av一区二区 | 亚洲 中文 欧美 日韩 在线观看 | 黄色国产 | 国产精品网址 | 91精品国产99 | 精品国产一区二区三区性色 | 国产精品久久久久久久久久免费 | 天天拍夜夜爽 | 久久精品国产一区 | 91传媒在线观看 | a级毛片基地 | av片在线观看 | 97国产一区二区精品久久呦 | 亚洲欧美成人影院 | 久久国产精品免费一区二区三区 | 超碰在线播 | www.亚洲成人网 | 搞黄视频免费看 | 国产精品精品视频一区二区三区 | 久久久xx | 欧美一区二区三区日韩 | 亚洲一区二区三区在线视频 | 午夜精品福利视频 | 成人av播放 | 日韩免费视频一区二区 | 成人国产在线观看 | 久久不卡 | 欧美日韩在线一区二区三区 |