Paparazzi UAS  v5.15_devel-230-gc96ce27
Paparazzi is a free software Unmanned Aircraft System.
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Modules Pages
l3gd20_spi.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2013 Felix Ruess <felix.ruess@gmail.com>
3  *
4  * This file is part of paparazzi.
5  *
6  * paparazzi is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2, or (at your option)
9  * any later version.
10  *
11  * paparazzi is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with paparazzi; see the file COPYING. If not, write to
18  * the Free Software Foundation, 59 Temple Place - Suite 330,
19  * Boston, MA 02111-1307, USA.
20  */
21 
28 #include "peripherals/l3gd20_spi.h"
29 
30 void l3gd20_spi_init(struct L3gd20_Spi *l3g, struct spi_periph *spi_p, uint8_t slave_idx)
31 {
32  /* set spi_peripheral */
33  l3g->spi_p = spi_p;
34 
35  /* configure spi transaction */
38  l3g->spi_trans.dss = SPIDss8bit;
40  l3g->spi_trans.cdiv = SPIDiv64;
41 
43  l3g->spi_trans.slave_idx = slave_idx;
44  l3g->spi_trans.output_length = 2;
45  l3g->spi_trans.input_length = 8;
46  // callback currently unused
47  l3g->spi_trans.before_cb = NULL;
48  l3g->spi_trans.after_cb = NULL;
49  l3g->spi_trans.input_buf = &(l3g->rx_buf[0]);
50  l3g->spi_trans.output_buf = &(l3g->tx_buf[0]);
51 
52  /* set inital status: Success or Done */
54 
55  /* set default L3GD20 config options */
57 
58  l3g->initialized = false;
59  l3g->data_available = false;
61 }
62 
63 
64 static void l3gd20_spi_write_to_reg(struct L3gd20_Spi *l3g, uint8_t _reg, uint8_t _val)
65 {
66  l3g->spi_trans.output_length = 2;
67  l3g->spi_trans.input_length = 0;
68  l3g->tx_buf[0] = _reg;
69  l3g->tx_buf[1] = _val;
70  spi_submit(l3g->spi_p, &(l3g->spi_trans));
71 }
72 
73 // Configuration function called once before normal use
74 static void l3gd20_spi_send_config(struct L3gd20_Spi *l3g)
75 {
76  uint8_t reg_val = 0;
77 
78  switch (l3g->init_status) {
79  case L3G_CONF_WHO_AM_I:
80  /* query device id */
81  l3g->spi_trans.output_length = 1;
82  l3g->spi_trans.input_length = 2;
83  /* set read bit then reg address */
84  l3g->tx_buf[0] = (1 << 7 | L3GD20_REG_WHO_AM_I);
85  if (spi_submit(l3g->spi_p, &(l3g->spi_trans))) {
86  l3g->init_status++;
87  }
88  break;
89  case L3G_CONF_REG4:
90  /* set SPI mode, Filtered Data Selection */
91  reg_val = (l3g->config.spi_3_wire << 0) | (l3g->config.full_scale << 4);
93  l3g->init_status++;
94  break;
95  case L3G_CONF_ENABLE:
96  /* set data rate, range, enable measurement, is in standby after power up */
97  reg_val = (l3g->config.drbw << 4) |
98  L3GD20_PD | // Power Down Control to active mode
99  L3GD20_Xen | L3GD20_Yen | L3GD20_Zen; // enable z,y,x axes
101  l3g->init_status++;
102  break;
103  case L3G_CONF_DONE:
104  l3g->initialized = true;
106  break;
107  default:
108  break;
109  }
110 }
111 
113 {
114  if (l3g->init_status == L3G_CONF_UNINIT) {
115  l3g->init_status++;
116  if (l3g->spi_trans.status == SPITransSuccess || l3g->spi_trans.status == SPITransDone) {
118  }
119  }
120 }
121 
122 void l3gd20_spi_read(struct L3gd20_Spi *l3g)
123 {
124  if (l3g->initialized && l3g->spi_trans.status == SPITransDone) {
125  l3g->spi_trans.output_length = 1;
126  l3g->spi_trans.input_length = 8;
127  /* set read bit and multiple byte bit, then address */
128  l3g->tx_buf[0] = (1 << 7 | 1 << 6 | L3GD20_REG_STATUS_REG);
129  spi_submit(l3g->spi_p, &(l3g->spi_trans));
130  }
131 }
132 
133 #define Int16FromBuf(_buf,_idx) ((int16_t)((_buf[_idx+1]<<8) | _buf[_idx]))
134 
135 void l3gd20_spi_event(struct L3gd20_Spi *l3g)
136 {
137  if (l3g->initialized) {
138  if (l3g->spi_trans.status == SPITransFailed) {
140  } else if (l3g->spi_trans.status == SPITransSuccess) {
141  // Successfull reading
142  if (bit_is_set(l3g->rx_buf[1], 3)) {
143  // new xyz data available
144  l3g->data_rates.rates.p = Int16FromBuf(l3g->rx_buf, 2);
145  l3g->data_rates.rates.q = Int16FromBuf(l3g->rx_buf, 4);
146  l3g->data_rates.rates.r = Int16FromBuf(l3g->rx_buf, 6);
147  l3g->data_available = true;
148  }
150  }
151  } else if (l3g->init_status != L3G_CONF_UNINIT) { // Configuring but not yet initialized
152  switch (l3g->spi_trans.status) {
153  case SPITransFailed:
154  l3g->init_status--; // Retry config (TODO max retry)
155  /* FALLTHROUGH */
156  case SPITransSuccess:
157  if (l3g->init_status == L3G_CONF_WHO_AM_I_OK) {
158  if (l3g->rx_buf[1] == L3GD20_WHO_AM_I) {
159  l3g->init_status++;
160  } else {
162  }
163  }
164  /* FALLTHROUGH */
165  case SPITransDone:
168  break;
169  default:
170  break;
171  }
172  }
173 }
#define L3GD20_Xen
Definition: l3gd20_regs.h:53
enum SPIClockPolarity cpol
clock polarity control
Definition: spi.h:155
#define L3GD20_REG_CTRL_REG1
Definition: l3gd20_regs.h:33
#define L3GD20_Zen
Definition: l3gd20_regs.h:55
enum SPIClockDiv cdiv
prescaler of main clock to use as SPI clock
Definition: spi.h:159
uint16_t output_length
number of data words to write
Definition: spi.h:152
void l3gd20_spi_start_configure(struct L3gd20_Spi *l3g)
Definition: l3gd20_spi.c:112
struct spi_transaction spi_trans
Definition: l3gd20_spi.h:40
void l3gd20_spi_event(struct L3gd20_Spi *l3g)
Definition: l3gd20_spi.c:135
CPHA = 1.
Definition: spi.h:75
struct spi_periph * spi_p
Definition: l3gd20_spi.h:39
enum L3gd20ConfStatus init_status
init status
Definition: l3gd20_spi.h:43
enum L3gd20DRBW drbw
Data rate and bandwidth.
Definition: l3gd20.h:47
bool spi_submit(struct spi_periph *p, struct spi_transaction *t)
Submit SPI transaction.
Definition: spi_arch.c:511
CPOL = 1.
Definition: spi.h:84
enum SPIBitOrder bitorder
MSB/LSB order.
Definition: spi.h:158
void l3gd20_spi_init(struct L3gd20_Spi *l3g, struct spi_periph *spi_p, uint8_t slave_idx)
Definition: l3gd20_spi.c:30
#define L3GD20_PD
Definition: l3gd20_regs.h:52
#define L3GD20_Yen
Definition: l3gd20_regs.h:54
volatile uint8_t * output_buf
pointer to transmit buffer for DMA
Definition: spi.h:150
enum SPISlaveSelect select
slave selection behavior
Definition: spi.h:154
volatile uint8_t tx_buf[2]
Definition: l3gd20_spi.h:41
enum SPIClockPhase cpha
clock phase control
Definition: spi.h:156
static void l3gd20_set_default_config(struct L3gd20Config *c)
Definition: l3gd20.h:50
enum L3gd20FullScale full_scale
gyro full scale
Definition: l3gd20.h:46
SPI peripheral structure.
Definition: spi.h:174
Definition: spi.h:90
Driver for L3GD20 3-axis gyroscope from ST using SPI.
SPICallback after_cb
NULL or function called after the transaction.
Definition: spi.h:161
bool spi_3_wire
Set 3-wire SPI mode, if FALSE: 4-wire SPI mode.
Definition: l3gd20.h:44
union L3gd20_Spi::@319 data_rates
static void l3gd20_spi_send_config(struct L3gd20_Spi *l3g)
Definition: l3gd20_spi.c:74
volatile uint8_t rx_buf[8]
Definition: l3gd20_spi.h:42
bool initialized
config done flag
Definition: l3gd20_spi.h:44
static void l3gd20_spi_write_to_reg(struct L3gd20_Spi *l3g, uint8_t _reg, uint8_t _val)
Definition: l3gd20_spi.c:64
#define L3GD20_WHO_AM_I
L3GD20 device identifier contained in L3GD20_REG_WHO_AM_I.
Definition: l3gd20_regs.h:46
uint16_t input_length
number of data words to read
Definition: spi.h:151
#define Int16FromBuf(_buf, _idx)
Definition: l3gd20_spi.c:133
volatile bool data_available
data ready flag
Definition: l3gd20_spi.h:45
unsigned char uint8_t
Definition: types.h:14
slave is selected before transaction and unselected after
Definition: spi.h:63
#define L3GD20_REG_STATUS_REG
Definition: l3gd20_regs.h:37
enum SPIDataSizeSelect dss
data transfer word size
Definition: spi.h:157
#define L3GD20_REG_WHO_AM_I
Definition: l3gd20_regs.h:32
uint8_t slave_idx
slave id: SPI_SLAVE0 to SPI_SLAVE4
Definition: spi.h:153
Definition: spi.h:125
volatile uint8_t * input_buf
pointer to receive buffer for DMA
Definition: spi.h:149
#define L3GD20_REG_CTRL_REG4
Definition: l3gd20_regs.h:36
SPICallback before_cb
NULL or function called before the transaction.
Definition: spi.h:160
void l3gd20_spi_read(struct L3gd20_Spi *l3g)
Definition: l3gd20_spi.c:122
struct L3gd20Config config
Definition: l3gd20_spi.h:50
enum SPITransactionStatus status
Definition: spi.h:162