1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
|
/**
******************************************************************************
* @file stm32wb5mm_dk_motion_sensors_ex.c
* @author MEMS Software Solutions Team
* @brief This file provides a set of functions needed to manage the
* motion sensors mounted on the STM32WB5MM-DK board (MB1292).
******************************************************************************
* @attention
*
* <h2><center>© Copyright (c) 2019 STMicroelectronics.
* All rights reserved.</center></h2>
*
* This software component is licensed by ST under BSD 3-Clause license,
* the "License"; You may not use this file except in compliance with the
* License. You may obtain a copy of the License at:
* opensource.org/licenses/BSD-3-Clause
*
******************************************************************************
*/
/* Includes ------------------------------------------------------------------*/
#include "stm32wb5mm_dk_motion_sensors_ex.h"
/** @addtogroup BSP BSP
* @{
*/
/** @addtogroup STM32WB5MM_DK STM32WB5MM-DK
* @{
*/
/** @defgroup STM32WB5MM_DK_MOTION_SENSOR_EX STM32WB5MM-DK MOTION SENSOR EX
* @{
*/
/** @defgroup STM32WB5MM_DK_MOTION_SENSOR_EX_Imported_Variables STM32WB5MM-DK MOTION SENSOR EX Imported Variables
* @{
*/
extern void *MotionCompObj[MOTION_SENSOR_INSTANCES_NBR];
/**
* @}
*/
/** @defgroup STM32WB5MM_DK_MOTION_SENSOR_EX_Exported_Functions STM32WB5MM-DK MOTION SENSOR EX Exported Functions
* @{
*/
/**
* @brief Get the status of data ready bit
* @param Instance the device instance
* @param Function Motion sensor function. Could be:
* - MOTION_GYRO and/or MOTION_ACCELERO for MOTION_SENSOR_ISM330DHCX_0
* - MOTION_MAGNETO for MOTION_SENSOR_IIS2MDC_0
* @param Status the pointer to the status
* @retval BSP status
*/
int32_t BSP_MOTION_SENSOR_Get_DRDY_Status(uint32_t Instance, uint32_t Function, uint8_t *Status)
{
int32_t ret;
switch (Instance)
{
#if (USE_MOTION_SENSOR_ISM330DHCX_0 == 1)
case MOTION_SENSOR_ISM330DHCX_0:
if ((Function & MOTION_ACCELERO) == MOTION_ACCELERO)
{
if (ISM330DHCX_ACC_Get_DRDY_Status(MotionCompObj[Instance], Status) != BSP_ERROR_NONE)
{
ret = BSP_ERROR_COMPONENT_FAILURE;
}
else
{
ret = BSP_ERROR_NONE;
}
}
else if ((Function & MOTION_GYRO) == MOTION_GYRO)
{
if (ISM330DHCX_GYRO_Get_DRDY_Status(MotionCompObj[Instance], Status) != BSP_ERROR_NONE)
{
ret = BSP_ERROR_COMPONENT_FAILURE;
}
else
{
ret = BSP_ERROR_NONE;
}
}
else
{
ret = BSP_ERROR_COMPONENT_FAILURE;
}
break;
#endif
default:
ret = BSP_ERROR_WRONG_PARAM;
break;
}
return ret;
}
/**
* @brief Get the register value
* @param Instance the device instance
* @param Reg address to be read
* @param Data pointer where the value is written to
* @retval BSP status
*/
int32_t BSP_MOTION_SENSOR_Read_Register(uint32_t Instance, uint8_t Reg, uint8_t *Data)
{
int32_t ret;
switch (Instance)
{
#if (USE_MOTION_SENSOR_ISM330DHCX_0 == 1)
case MOTION_SENSOR_ISM330DHCX_0:
if (ISM330DHCX_Read_Reg(MotionCompObj[Instance], Reg, Data) != BSP_ERROR_NONE)
{
ret = BSP_ERROR_COMPONENT_FAILURE;
}
else
{
ret = BSP_ERROR_NONE;
}
break;
#endif
default:
ret = BSP_ERROR_WRONG_PARAM;
break;
}
return ret;
}
/**
* @brief Set the register value
* @param Instance the device instance
* @param Reg address to be read
* @param Data value to be written
* @retval BSP status
*/
int32_t BSP_MOTION_SENSOR_Write_Register(uint32_t Instance, uint8_t Reg, uint8_t Data)
{
int32_t ret;
switch (Instance)
{
#if (USE_MOTION_SENSOR_ISM330DHCX_0 == 1)
case MOTION_SENSOR_ISM330DHCX_0:
if (ISM330DHCX_Write_Reg(MotionCompObj[Instance], Reg, Data) != BSP_ERROR_NONE)
{
ret = BSP_ERROR_COMPONENT_FAILURE;
}
else
{
ret = BSP_ERROR_NONE;
}
break;
#endif
default:
ret = BSP_ERROR_WRONG_PARAM;
break;
}
return ret;
}
/**
* @}
*/
/**
* @}
*/
/**
* @}
*/
/**
* @}
*/
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
