Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
adxl345_i2c.c
Go to the documentation of this file.
1/*
2 * Copyright (C) 2011 Gautier Hattenberger <gautier.hattenberger@enac.fr>
3 * 2013 Felix Ruess <felix.ruess@gmail.com>
4 *
5 * This file is part of paparazzi.
6 *
7 * paparazzi is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2, or (at your option)
10 * any later version.
11 *
12 * paparazzi is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with paparazzi; see the file COPYING. If not, write to
19 * the Free Software Foundation, 59 Temple Place - Suite 330,
20 * Boston, MA 02111-1307, USA.
21 */
22
29
31#include "std.h"
32
33#define ADXL345_DATA_FORMAT ((adxl->config.int_invert<<5)|(adxl->config.full_res<<3)|(adxl->config.justify_msb<<2)|(adxl->config.range))
34
35
36void adxl345_i2c_init(struct Adxl345_I2c *adxl, struct i2c_periph *i2c_p, uint8_t addr)
37{
38 /* set i2c_peripheral */
39 adxl->i2c_p = i2c_p;
40 /* set i2c address */
41 adxl->i2c_trans.slave_addr = addr;
43 /* set default config options */
45 adxl->initialized = false;
47}
48
49static void adxl345_i2c_tx_reg(struct Adxl345_I2c *adxl, uint8_t reg, uint8_t val)
50{
52 adxl->i2c_trans.buf[0] = reg;
53 adxl->i2c_trans.buf[1] = val;
54 adxl->i2c_trans.len_r = 0;
55 adxl->i2c_trans.len_w = 2;
56 i2c_submit(adxl->i2c_p, &(adxl->i2c_trans));
57}
58
59// Configuration function called once before normal use
60static void adxl345_i2c_send_config(struct Adxl345_I2c *adxl)
61{
62 switch (adxl->init_status) {
63 case ADXL_CONF_RATE:
65 adxl->init_status++;
66 break;
67 case ADXL_CONF_INT:
69 adxl->init_status++;
70 break;
73 adxl->init_status++;
74 break;
76 /* enable measurement, is in standby after power up */
78 adxl->init_status++;
79 break;
80 case ADXL_CONF_DONE:
81 adxl->initialized = true;
83 break;
84 default:
85 break;
86 }
87}
88
91{
92 if (adxl->init_status == ADXL_CONF_UNINIT) {
93 adxl->init_status++;
96 }
97 }
98}
99
100// Normal reading
102{
103 if (adxl->initialized && adxl->i2c_trans.status == I2CTransDone) {
106 adxl->i2c_trans.len_r = 6;
107 adxl->i2c_trans.len_w = 1;
108 i2c_submit(adxl->i2c_p, &(adxl->i2c_trans));
109 }
110}
111
112#define Int16FromBuf(_buf,_idx) ((int16_t)((_buf[_idx+1]<<8) | _buf[_idx]))
113
115{
116 if (adxl->initialized) {
117 if (adxl->i2c_trans.status == I2CTransFailed) {
119 } else if (adxl->i2c_trans.status == I2CTransSuccess) {
120 // Successfull reading
121 adxl->data.vect.x = Int16FromBuf(adxl->i2c_trans.buf, 0);
122 adxl->data.vect.y = Int16FromBuf(adxl->i2c_trans.buf, 2);
123 adxl->data.vect.z = Int16FromBuf(adxl->i2c_trans.buf, 4);
124 adxl->data_available = true;
126 }
127 } else if (adxl->init_status != ADXL_CONF_UNINIT) { // Configuring but not yet initialized
128 if (adxl->i2c_trans.status == I2CTransSuccess || adxl->i2c_trans.status == I2CTransDone) {
131 }
132 if (adxl->i2c_trans.status == I2CTransFailed) {
133 adxl->init_status--;
135 adxl345_i2c_send_config(adxl); // Retry config (TODO max retry)
136 }
137 }
138}
bool drdy_int_enable
Enable Data Ready Interrupt.
Definition adxl345.h:46
enum Adxl345Rates rate
Data Output Rate.
Definition adxl345.h:53
static void adxl345_set_default_config(struct Adxl345Config *c)
Definition adxl345.h:56
@ ADXL_CONF_FORMAT
Definition adxl345.h:40
@ ADXL_CONF_DONE
Definition adxl345.h:42
@ ADXL_CONF_RATE
Definition adxl345.h:38
@ ADXL_CONF_INT
Definition adxl345.h:39
@ ADXL_CONF_ENABLE
Definition adxl345.h:41
@ ADXL_CONF_UNINIT
Definition adxl345.h:37
void adxl345_i2c_start_configure(struct Adxl345_I2c *adxl)
Start configuration if not already done.
Definition adxl345_i2c.c:90
void adxl345_i2c_read(struct Adxl345_I2c *adxl)
static void adxl345_i2c_tx_reg(struct Adxl345_I2c *adxl, uint8_t reg, uint8_t val)
Definition adxl345_i2c.c:49
#define ADXL345_DATA_FORMAT
Definition adxl345_i2c.c:33
static void adxl345_i2c_send_config(struct Adxl345_I2c *adxl)
Definition adxl345_i2c.c:60
void adxl345_i2c_init(struct Adxl345_I2c *adxl, struct i2c_periph *i2c_p, uint8_t addr)
Definition adxl345_i2c.c:36
void adxl345_i2c_event(struct Adxl345_I2c *adxl)
#define Int16FromBuf(_buf, _idx)
Driver for the accelerometer ADXL345 from Analog Devices using I2C.
struct Adxl345Config config
Definition adxl345_i2c.h:49
volatile bool data_available
data ready flag
Definition adxl345_i2c.h:44
bool initialized
config done flag
Definition adxl345_i2c.h:43
struct i2c_periph * i2c_p
Definition adxl345_i2c.h:40
enum Adxl345ConfStatus init_status
init status
Definition adxl345_i2c.h:42
struct i2c_transaction i2c_trans
Definition adxl345_i2c.h:41
union Adxl345_I2c::@140176107040335352041202030270154202275276366221 data
#define ADXL345_REG_DATA_X0
#define ADXL345_REG_BW_RATE
#define ADXL345_REG_DATA_FORMAT
#define ADXL345_REG_POWER_CTL
#define ADXL345_REG_INT_ENABLE
volatile uint8_t buf[I2C_BUF_LEN]
Transaction buffer With I2C_BUF_LEN number of bytes.
Definition i2c.h:123
uint16_t len_r
Number of bytes to read/receive.
Definition i2c.h:111
enum I2CTransactionType type
Transaction type.
Definition i2c.h:99
enum I2CTransactionStatus status
Transaction status.
Definition i2c.h:127
uint8_t slave_addr
Slave address.
Definition i2c.h:105
uint8_t len_w
Number of bytes to write/transmit.
Definition i2c.h:117
static bool i2c_submit(struct i2c_periph *p, struct i2c_transaction *t)
Submit a I2C transaction.
Definition i2c.h:271
@ I2CTransSuccess
transaction successfully finished by I2C driver
Definition i2c.h:58
@ I2CTransFailed
transaction failed
Definition i2c.h:59
@ I2CTransDone
transaction set to done by user level
Definition i2c.h:60
@ I2CTransTx
transmit only transaction
Definition i2c.h:48
@ I2CTransTxRx
transmit and receive transaction
Definition i2c.h:50
uint16_t val[TCOUPLE_NB]
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.