Skip to content

Navigation Menu

Sign in
Appearance settings

Search code, repositories, users, issues, pull requests...

Provide feedback

We read every piece of feedback, and take your input very seriously.

Saved searches

Use saved searches to filter your results more quickly
Appearance settings

Expand file tree

/

main.cpp

Copy path
More file actions
More file actions

Latest commit

 

History

History
History
101 lines (81 loc) · 2.38 KB
/

main.cpp

Copy path

File metadata and controls

101 lines (81 loc) · 2.38 KB
Raw
Copy raw file
Download raw file
Open symbols panel
Edit and raw actions
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
/*
* Copyright (c) 2014-2018, Niklas Hauser
* Copyright (c) 2015, Kevin Läufer
* Copyright (c) 2015, Martin Esser
*
* This file is part of the modm project.
*
* This Source Code Form is subject to the terms of the Mozilla Public
* License, v. 2.0. If a copy of the MPL was not distributed with this
* file, You can obtain one at http://mozilla.org/MPL/2.0/.
*/
// ----------------------------------------------------------------------------
#include <modm/board.hpp>
#include <modm/driver/inertial/lis302dl.hpp>
#include <modm/processing.hpp>
#include <modm/math/filter.hpp>
// ST changed the accelerometer in the C revision (MB997C)
// change this to `false`, if you have MB997A or MB997B!
#define REVISION_C true
// if you want to use Software I2c change this to `true`
#define USE_I2C false
namespace lis
{
#if USE_I2C
// I2c Transport Layer
typedef GpioA5 Scl;
typedef GpioA7 Sda;
typedef BitBangI2cMaster<Scl, Sda> I2cMaster;
typedef modm::Lis3TransportI2c< I2cMaster > Transport;
#else
typedef Board::lis3::Transport Transport;
#endif
} // namespace lis3
// Data and Driver object
#if REVISION_C
modm::lis3dsh::Data data;
modm::Lis3dsh< lis::Transport > accel(data);
#else
modm::lis302dl::Data data;
modm::Lis302dl< lis::Transport > accel(data);
#endif
modm::filter::MovingAverage<float, 25> averageX;
modm::filter::MovingAverage<float, 25> averageY;
int
main()
{
Board::initialize();
#if USE_I2C
Board::lis3::Cs::setOutput(modm::Gpio::High);
Board::lis3::Mosi::setOutput(modm::Gpio::High);
lis::I2cMaster::connect<lis::Scl::BitBang, lis::Sda::BitBang>(lis::I2cMaster::PullUps::Internal);
lis::I2cMaster::initialize<Board::SystemClock, 400_kHz>();
#else
Board::initializeLis3();
#endif
while(not accel.ping())
{
Board::LedOrange::set();
modm::delay(100ms);
Board::LedOrange::reset();
}
// initialize with limited range of ~2.3G
accel.configure(accel.Scale::G2, accel.MeasurementRate::Hz400);
while (true)
{
accel.readAcceleration();
#if REVISION_C
averageX.update(-accel.getData().getY());
averageY.update(accel.getData().getX());
#else
averageX.update(accel.getData().getX());
averageY.update(accel.getData().getY());
#endif
Board::LedOrange::set(averageX.getValue() < -0.2f);
Board::LedBlue::set(averageX.getValue() > 0.2f);
Board::LedGreen::set(averageY.getValue() < -0.2f);
Board::LedRed::set(averageY.getValue() > 0.2f);
modm::delay(5ms);
}
return 0;
}
Morty Proxy This is a proxified and sanitized view of the page, visit original site.