airbourne/airbourne/examples/i2c_multi/main.cpp
Go to the documentation of this file.
1 /*
2  * Copyright (c) 2017, James Jackson
3  *
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions are met:
8  *
9  * * Redistributions of source code must retain the above copyright notice, this
10  * list of conditions and the following disclaimer.
11  *
12  * * Redistributions in binary form must reproduce the above copyright notice,
13  * this list of conditions and the following disclaimer in the documentation
14  * and/or other materials provided with the distribution.
15  *
16  * * Neither the name of the copyright holder nor the names of its
17  * contributors may be used to endorse or promote products derived from
18  * this software without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
21  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
23  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
26  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
27  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
28  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
29  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30  */
31 
32 #include "hmc5883l.h"
33 #include "i2c.h"
34 #include "led.h"
35 #include "ms4525.h"
36 #include "ms5611.h"
37 #include "printf.h"
38 #include "system.h"
39 #include "vcp.h"
40 
42 
43 static void _putc(void* p, char c)
44 {
45  (void)p; // avoid compiler warning about unused variable
46  uartPtr->put_byte(c);
47 }
48 
49 int main()
50 {
51  systemInit();
52 
53  VCP vcp;
54  vcp.init();
55  uartPtr = &vcp;
57 
58  LED warn;
59  warn.init(LED1_GPIO, LED1_PIN);
60  LED info;
61  info.init(LED2_GPIO, LED2_PIN);
62 
63  delay(500);
64 
65  info.on();
66 
67  // Initialize the I2C peripherals1
68  I2C i2c1;
69  I2C i2c2;
70  i2c1.init(&i2c_config[BARO_I2C]);
71  // i2c2.init(&i2c_config[EXTERNAL_I2C]);
72 
73  // Initialize the sensors
74  MS5611 baro;
75  HMC5883L mag;
76  // MS4525 airspeed;
77 
78  // Initialize the barometer
79  float pressure(0.0), baro_temp(0.0);
80  baro.init(&i2c1);
81 
82  // Initialize the Magnetometer
83  float mag_data[3] = {0., 0., 0.};
84  mag.init(&i2c1);
85 
86  // Initialize the airspeed Sensor
87  float diff_press(0.0), as_temp(0.0);
88  // airspeed.init(&i2c2);
89 
90  uint32_t count;
91  uint32_t last_print = 0;
92  while (1)
93  {
94  baro.update();
95  mag.update();
96  // airspeed.update();
97  if (baro.present())
98  {
99  baro.read(&pressure, &baro_temp);
100  }
101  else
102  {
103  pressure = 0.0;
104  baro_temp = 0.0;
105  }
106 
107  double seconds = millis() / 1000.0;
108 
109  if (mag.present())
110  {
111  mag.read(mag_data);
112  }
113  else
114  {
115  for (int i = 0; i < 3; i++) mag_data[i] = 0.0;
116  }
117  // if (airspeed.present())
118  // {
119  // airspeed.read(&diff_press, &as_temp);
120  // }
121  // else
122  // {
123  // diff_press = 0.0;
124  // as_temp = 0.0;
125  // }
126 
127  if (pressure == 0.0 || baro_temp == 0.0 || mag_data[0] == 0.0)
128  warn.on();
129  else
130  warn.off();
131 
132  if (millis() > last_print + 20)
133  {
134  if (count++ % 10 == 0)
135  info.toggle();
136  last_print = millis();
137  printf("t: %.2f\t", seconds);
138  printf("baro: %d Pa, %.2f K\t", (int32_t)pressure, (double)baro_temp);
139  printf("mag: %d, %d, %d\t", (int32_t)(mag_data[0]), (int32_t)(mag_data[1]), (int32_t)(mag_data[2]));
140  // printf("as: %.2f Pa, %.2fC\t", (double)diff_press, (double)as_temp);
141  printf("err1: %d\t err2:%d\n", i2c1.num_errors(), i2c2.num_errors());
142  }
143  }
144 }
void systemInit(void)
Definition: system.c:55
void toggle(void)
Definition: gpio.cpp:52
volatile uint32_t millis(void)
Definition: system.c:50
float pressure
Definition: ms4525.c:41
void init(GPIO_TypeDef *gpio_port, uint16_t pin)
Definition: led.cpp:34
#define LED2_PIN
Definition: revo_f4.h:129
void init(const i2c_hardware_struct_t *c)
Definition: i2c.cpp:52
Definition: ms5611.h:38
void init()
Definition: vcp.cpp:24
#define LED2_GPIO
Definition: revo_f4.h:128
Definition: led.h:38
bool present()
Definition: hmc5883l.cpp:69
#define LED1_GPIO
Definition: revo_f4.h:126
uint16_t num_errors()
Definition: i2c.h:145
bool init(I2C *_i2c)
Definition: ms5611.cpp:39
#define LED1_PIN
Definition: revo_f4.h:127
void put_byte(uint8_t ch) override
Definition: vcp.cpp:102
void update()
Definition: hmc5883l.cpp:76
void on()
Definition: led.cpp:39
Definition: vcp.h:19
void update()
Definition: ms5611.cpp:101
static void _putc(void *p, char c)
#define BARO_I2C
Definition: revo_f4.h:122
Definition: i2c.h:39
int16_t mag_data[3]
Definition: hmc5883l_read.c:28
bool present()
Definition: ms5611.cpp:94
#define NULL
Definition: usbd_def.h:50
bool init(I2C *i2c_drv)
Definition: hmc5883l.cpp:37
bool read(float mag_data[])
Definition: hmc5883l.cpp:100
void init_printf(void *putp, void(*putf)(void *, char))
Definition: printf.cpp:264
void off()
Definition: led.cpp:44
const i2c_hardware_struct_t i2c_config[NUM_I2C]
Definition: revo_f4.h:116
void read(float *press, float *temp)
Definition: ms5611.cpp:384
void delay(uint32_t ms)
Definition: system.c:101


rosflight_firmware
Author(s): Daniel Koch , James Jackson
autogenerated on Sat May 9 2020 03:16:52