1 /*
2  * Copyright (c) 2016, Freescale Semiconductor, Inc.
3  * Copyright 2016-2017 NXP
4  * All rights reserved.
5  *
6  * SPDX-License-Identifier: BSD-3-Clause
7  */
8 
9 /**
10  * @file fxpq3115_altitude.c
11  * @brief The fxpq3115_altitude.c file implements the ISSDK FXPQ3115BV sensor driver
12  *        example demonstration for Altitude mode.
13  */
14 
15 //-----------------------------------------------------------------------
16 // SDK Includes
17 //-----------------------------------------------------------------------
18 #include "pin_mux.h"
19 #include "clock_config.h"
20 #include "board.h"
21 #include "fsl_debug_console.h"
22 
23 //-----------------------------------------------------------------------
24 // CMSIS Includes
25 //-----------------------------------------------------------------------
26 #include "Driver_I2C.h"
27 
28 /* ISSDK Includes */
29 #include "issdk_hal.h"
30 #include "fxpq3115_drv.h"
31 
32 //-----------------------------------------------------------------------
33 // Macros
34 //-----------------------------------------------------------------------
35 #define FXPQ3115_DATA_SIZE (5) /* 3 byte Pressure/Altitude and 2 byte Temperature. */
36 /*! In FXPQ3115 the Auto Acquisition Time Step (ODR) can be set only in powers of 2 (i.e. 2^x, where x is the
37  *  SAMPLING_EXPONENT).
38  *  This gives a range of 1 second to 2^15 seconds (9 hours). */
39 #define FXPQ3115_SAMPLING_EXPONENT (1) /* 2 seconds */
40 
41 //-----------------------------------------------------------------------
42 // Constants
43 //-----------------------------------------------------------------------
44 /*! @brief Register settings for Altitude readings in Poll (non buffered) mode. */
45 const registerwritelist_t B3115ConfigAltitude[] = {
46     /* Enable Data Ready and Event flags for Altitude, Temperature or either. */
47     {FXPQ3115_PT_DATA_CFG,
48      FXPQ3115_PT_DATA_CFG_TDEFE_ENABLED | FXPQ3115_PT_DATA_CFG_PDEFE_ENABLED | FXPQ3115_PT_DATA_CFG_DREM_ENABLED,
49      FXPQ3115_PT_DATA_CFG_TDEFE_MASK | FXPQ3115_PT_DATA_CFG_PDEFE_MASK | FXPQ3115_PT_DATA_CFG_DREM_MASK},
50     /* Enable Altitude output and set Over Sampling Ratio to 128. */
51     {FXPQ3115_CTRL_REG1, FXPQ3115_CTRL_REG1_ALT_ALT | FXPQ3115_CTRL_REG1_OS_OSR_128,
52      FXPQ3115_CTRL_REG1_ALT_MASK | FXPQ3115_CTRL_REG1_OS_MASK},
53     /* Set Auto acquisition time step. */
54     {FXPQ3115_CTRL_REG2, FXPQ3115_SAMPLING_EXPONENT, FXPQ3115_CTRL_REG2_ST_MASK},
55     __END_WRITE_DATA__};
56 
57 /*! @brief Address of Status Register. */
58 const registerreadlist_t B3115Status[] = {{.readFrom = FXPQ3115_STATUS, .numBytes = 1}, __END_READ_DATA__};
59 
60 /*! @brief Address and size of Raw Altitude+Temperature Data in Poll Mode. */
61 const registerreadlist_t B3115OutputPoll[] = {{.readFrom = FXPQ3115_OUT_P_MSB, .numBytes = FXPQ3115_DATA_SIZE},
62                                               __END_READ_DATA__};
63 
64 //-----------------------------------------------------------------------
65 // Functions
66 //-----------------------------------------------------------------------
67 /*!
68  * @brief Main function
69  */
main(void)70 int main(void)
71 {
72     int16_t tempInDegrees;
73     int32_t altitudeInMeters;
74     int32_t status;
75     uint8_t dataReady;
76     uint8_t data[FXPQ3115_DATA_SIZE];
77     fxpq3115_altitudedata_t rawData;
78 
79     ARM_DRIVER_I2C *I2Cdrv = &I2C_S_DRIVER; // Now using the shield.h value!!!
80     fxpq3115_i2c_sensorhandle_t fxpq3115Driver;
81 
82     BOARD_InitPins();
83     BOARD_BootClockRUN();
84     BOARD_InitDebugConsole();
85 
86     PRINTF("\r\n ISSDK FXPQ3115 sensor driver example demonstration with poll mode\r\n");
87 
88     /*! Initialize the I2C driver. */
89     status = I2Cdrv->Initialize(I2C_S_SIGNAL_EVENT);
90     if (ARM_DRIVER_OK != status)
91     {
92         PRINTF("\r\n I2C Initialization Failed\r\n");
93         return -1;
94     }
95 
96     /*! Set the I2C Power mode. */
97     status = I2Cdrv->PowerControl(ARM_POWER_FULL);
98     if (ARM_DRIVER_OK != status)
99     {
100         PRINTF("\r\n I2C Power Mode setting Failed\r\n");
101         return -1;
102     }
103 
104     /*! Set the I2C bus speed. */
105     status = I2Cdrv->Control(ARM_I2C_BUS_SPEED, ARM_I2C_BUS_SPEED_FAST);
106     if (ARM_DRIVER_OK != status)
107     {
108         PRINTF("\r\n I2C Control Mode setting Failed\r\n");
109         return -1;
110     }
111 
112     /*! Initialize FXPQ3115 sensor driver. */
113     status = FXPQ3115_I2C_Initialize(&fxpq3115Driver, &I2C_S_DRIVER, I2C_S_DEVICE_INDEX, FXPQ3115_I2C_ADDR,
114                                      FXPQ3115_WHOAMI_VALUE);
115     if (SENSOR_ERROR_NONE != status)
116     {
117         PRINTF("\r\n Sensor Initialization Failed\r\n");
118         return -1;
119     }
120     PRINTF("\r\n Successfully Initiliazed Sensor\r\n");
121 
122     /*!  Set the task to be executed while waiting for I2C transactions to complete. */
123     FXPQ3115_I2C_SetIdleTask(&fxpq3115Driver, (registeridlefunction_t)SMC_SetPowerModeVlpr, SMC);
124 
125     /*! Configure the FXPQ3115 sensor. */
126     status = FXPQ3115_I2C_Configure(&fxpq3115Driver, B3115ConfigAltitude);
127     if (SENSOR_ERROR_NONE != status)
128     {
129         PRINTF("\r\n FXPQ3115 sensor configuration failed.\r\n");
130         return -1;
131     }
132     PRINTF("\r\n Successfully Applied FXPQ3115 Sensor Configuration\r\n");
133 
134     for (;;) /* Forever loop */
135     {
136         /*! Wait for data ready from the FXPQ3115. */
137         status = FXPQ3115_I2C_ReadData(&fxpq3115Driver, B3115Status, &dataReady);
138         if (0 == (dataReady & FXPQ3115_DR_STATUS_PTDR_MASK))
139         { /* Loop, if new sample is not available. */
140             continue;
141         }
142 
143         /*! Read new raw sensor data from the FXPQ3115. */
144         status = FXPQ3115_I2C_ReadData(&fxpq3115Driver, B3115OutputPoll, data);
145         if (ARM_DRIVER_OK != status)
146         {
147             PRINTF("\r\n Read Failed. \r\n");
148             return -1;
149         }
150 
151         /*! Process the sample and convert the raw sensor data. */
152         rawData.altitude = (int32_t)((data[0]) << 24) | ((data[1]) << 16) | ((data[2]) << 8);
153         altitudeInMeters = rawData.altitude / FXPQ3115_ALTITUDE_CONV_FACTOR;
154 
155         rawData.temperature = (int16_t)((data[3]) << 8) | (data[4]);
156         tempInDegrees = rawData.temperature / FXPQ3115_TEMPERATURE_CONV_FACTOR;
157 
158         PRINTF("\r\n Altitude    = %d Meters\r\n", altitudeInMeters);
159         PRINTF("\r\n Temperature = %d degC\r\n", tempInDegrees);
160         ASK_USER_TO_RESUME(8); /* Ask for user input after processing 8 samples. */
161     }
162 }
163