andreika-git
/
ChibiOS
mirror of https://github.com/andreika-git/ChibiOS.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

lsm303agr: check WHO_AM_I register on lsm303agrStart()

This commit is contained in:
Andrey Gusakov 2023-12-14 02:17:58 +03:00
parent 240b3ca51f
commit ce4ef6d59d
2 changed files with 13 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
os/ex/devices/ST/lsm303agr.c
View File

@ -775,8 +775,9 @@ void lsm303agrObjectInit(LSM303AGRDriver *devp) {
*
* @api
*/
void lsm303agrStart(LSM303AGRDriver *devp, const LSM303AGRConfig *config) {
msg_t lsm303agrStart(LSM303AGRDriver *devp, const LSM303AGRConfig *config) {
uint32_t i;
uint8_t devid;
uint8_t cr[4];
osalDbgCheck((devp != NULL) && (config != NULL));
@ -871,6 +872,14 @@ void lsm303agrStart(LSM303AGRDriver *devp, const LSM303AGRConfig *config) {
#endif /* LSM303AGR_SHARED_I2C || LSM303AGR_SHARED_SPI */
lsm303agrStartBus(devp->config);
/* Check WHO_I_AM */
lsm303agrReadRegister(devp->config, LSM303AGR_SAD_ACC,
LSM303AGR_AD_WHO_AM_I_A, &devid, 1);
if (devid != 0x33)
{
return MSG_RESET;
}
lsm303agrWriteRegister(devp->config, LSM303AGR_SAD_ACC,
LSM303AGR_AD_CTRL_REG1_A, cr, 4);
@ -915,6 +924,8 @@ void lsm303agrStart(LSM303AGRDriver *devp, const LSM303AGRConfig *config) {
osalThreadSleepMilliseconds(5);
devp->state = LSM303AGR_READY;
return MSG_OK;
}
/**

2
os/ex/devices/ST/lsm303agr.h
View File

@ -919,7 +919,7 @@ struct LSM303AGRDriver {
extern "C" {
#endif
void lsm303agrObjectInit(LSM303AGRDriver *devp);
void lsm303agrStart(LSM303AGRDriver *devp, const LSM303AGRConfig *config);
msg_t lsm303agrStart(LSM303AGRDriver *devp, const LSM303AGRConfig *config);
void lsm303agrStop(LSM303AGRDriver *devp);
#ifdef __cplusplus
}