-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
- Loading branch information
0 parents
commit b630891
Showing
7 changed files
with
306 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,5 @@ | ||
.pio | ||
.vscode/.browse.c_cpp.db* | ||
.vscode/c_cpp_properties.json | ||
.vscode/launch.json | ||
.vscode/ipch |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,7 @@ | ||
{ | ||
// See http://go.microsoft.com/fwlink/?LinkId=827846 | ||
// for the documentation about the extensions.json format | ||
"recommendations": [ | ||
"platformio.platformio-ide" | ||
] | ||
} |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,39 @@ | ||
|
||
This directory is intended for project header files. | ||
|
||
A header file is a file containing C declarations and macro definitions | ||
to be shared between several project source files. You request the use of a | ||
header file in your project source file (C, C++, etc) located in `src` folder | ||
by including it, with the C preprocessing directive `#include'. | ||
|
||
```src/main.c | ||
|
||
#include "header.h" | ||
|
||
int main (void) | ||
{ | ||
... | ||
} | ||
``` | ||
|
||
Including a header file produces the same results as copying the header file | ||
into each source file that needs it. Such copying would be time-consuming | ||
and error-prone. With a header file, the related declarations appear | ||
in only one place. If they need to be changed, they can be changed in one | ||
place, and programs that include the header file will automatically use the | ||
new version when next recompiled. The header file eliminates the labor of | ||
finding and changing all the copies as well as the risk that a failure to | ||
find one copy will result in inconsistencies within a program. | ||
|
||
In C, the usual convention is to give header files names that end with `.h'. | ||
It is most portable to use only letters, digits, dashes, and underscores in | ||
header file names, and at most one dot. | ||
|
||
Read more about using header files in official GCC documentation: | ||
|
||
* Include Syntax | ||
* Include Operation | ||
* Once-Only Headers | ||
* Computed Includes | ||
|
||
https://gcc.gnu.org/onlinedocs/cpp/Header-Files.html |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,46 @@ | ||
|
||
This directory is intended for project specific (private) libraries. | ||
PlatformIO will compile them to static libraries and link into executable file. | ||
|
||
The source code of each library should be placed in a an own separate directory | ||
("lib/your_library_name/[here are source files]"). | ||
|
||
For example, see a structure of the following two libraries `Foo` and `Bar`: | ||
|
||
|--lib | ||
| | | ||
| |--Bar | ||
| | |--docs | ||
| | |--examples | ||
| | |--src | ||
| | |- Bar.c | ||
| | |- Bar.h | ||
| | |- library.json (optional, custom build options, etc) https://docs.platformio.org/page/librarymanager/config.html | ||
| | | ||
| |--Foo | ||
| | |- Foo.c | ||
| | |- Foo.h | ||
| | | ||
| |- README --> THIS FILE | ||
| | ||
|- platformio.ini | ||
|--src | ||
|- main.c | ||
|
||
and a contents of `src/main.c`: | ||
``` | ||
#include <Foo.h> | ||
#include <Bar.h> | ||
|
||
int main (void) | ||
{ | ||
... | ||
} | ||
|
||
``` | ||
|
||
PlatformIO Library Dependency Finder will find automatically dependent | ||
libraries scanning project source files. | ||
|
||
More information about PlatformIO Library Dependency Finder | ||
- https://docs.platformio.org/page/librarymanager/ldf.html |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,18 @@ | ||
; PlatformIO Project Configuration File | ||
; | ||
; Build options: build flags, source filter | ||
; Upload options: custom upload port, speed and extra flags | ||
; Library options: dependencies, extra library storages | ||
; Advanced options: extra scripting | ||
; | ||
; Please visit documentation for the other options and examples | ||
; https://docs.platformio.org/page/projectconf.html | ||
|
||
[env:uno] | ||
platform = atmelavr | ||
board = uno | ||
framework = arduino | ||
lib_deps = | ||
majicdesigns/MD_MAX72XX@^3.3.0 | ||
ericksimoes/Ultrasonic@^3.0.0 | ||
arduino-libraries/Servo@^1.1.7 |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,180 @@ | ||
#include <Arduino.h> | ||
#include <MD_MAX72xx.h> | ||
#include <Servo.h> | ||
#include <Ultrasonic.h> | ||
|
||
#define forceinline __attribute__((always_inline)) // "inline" on its own doesn't work reliably in Arduino projects | ||
|
||
|
||
// ✨ user parameters ✨ | ||
|
||
// 📍 pin configuration | ||
namespace pins { | ||
|
||
// 📡 ultrasonic pins | ||
namespace ultrasonic { | ||
constexpr int | ||
trig = 4, | ||
echo = 3; | ||
} // since pins don't change at runtime, constexpr tells the compiler to copy-and-paste values into our code | ||
|
||
// 💡 display pins | ||
namespace display { | ||
constexpr int | ||
CS = 6, | ||
DIN = 5, | ||
CLK = 7; | ||
} | ||
|
||
// ⚙ servo pin | ||
constexpr int servo = 2; | ||
} | ||
|
||
// 🔧 device settings | ||
namespace settings { | ||
|
||
// 📡 ultrasonic settings | ||
namespace ultrasonic { | ||
constexpr int | ||
samples = 20, // how many measurements to average per ray; trades speed for precision | ||
angleStep = 3, // degrees; how far to turn between rays; trades speed for precision | ||
maxDistance = 50, // centimeters; greater distances squish the output more (HC-SR04 supports 400cm) | ||
timeout = 5000; // microseconds; how long to wait for a sonar response before moving on | ||
} | ||
} | ||
|
||
// ✨ --------------- ✨ | ||
|
||
|
||
// 📦 runtime variables 📦 | ||
|
||
// ultrasonic sensor object with the pins & settings we set | ||
Ultrasonic ultrasonic( | ||
pins::ultrasonic::trig, | ||
pins::ultrasonic::echo, | ||
settings::ultrasonic::timeout | ||
); | ||
|
||
// 8×8 display object with the pins we set | ||
MD_MAX72XX display( | ||
MD_MAX72XX::GENERIC_HW, | ||
pins::display::DIN, | ||
pins::display::CLK, | ||
pins::display::CS | ||
); | ||
|
||
// servo object (pin passed in at setup) | ||
Servo servo; | ||
|
||
// which way the sensor is turning | ||
bool direction = 0; | ||
|
||
// 📦 ----------------- 📦 | ||
|
||
|
||
// 🤖 i/o processing 🤖 | ||
|
||
// stores a point as both a polar and cartesian representation | ||
struct Polar { | ||
int x, y, radius, angle; | ||
|
||
// construct a Polar from radius & angle (degrees) | ||
Polar(const float radius, const int angle): | ||
radius(radius), | ||
angle(angle) | ||
{ | ||
const float angleRadians = radians(angle); | ||
x = radius * cos(angleRadians); | ||
y = radius * sin(angleRadians); | ||
} | ||
}; | ||
|
||
// map big, linear ultrasonic distances to displayable distances | ||
inline int scale(const float) forceinline; // inline to do simple calculations in-place where possible | ||
inline int scale(const float reading) { | ||
return 8 * log(reading + 1) / log(settings::ultrasonic::maxDistance); // logarithmic | ||
// return 8 * reading / maxDistance; // linear | ||
} | ||
|
||
// meaure how far the sensor can see at the specified angle (degrees) | ||
Polar scanTo(const int angle) { | ||
// turn the sensor | ||
servo.write(angle); | ||
|
||
// average the number of samples set in parameters | ||
int sampleSum = 0; | ||
for (int i = 0; i < settings::ultrasonic::samples; i++) { | ||
sampleSum += ultrasonic.read(); | ||
} | ||
|
||
const int average = sampleSum / settings::ultrasonic::samples; | ||
|
||
// scale the distance | ||
const int scaled = scale(average); | ||
|
||
// return the point as a Polar | ||
return Polar(scaled, angle); | ||
} | ||
|
||
// given a display point, illuminate all points on the radius until we reach the point | ||
void fillRadial(const Polar& stop) { | ||
for (int i = 0; i <= stop.radius; i++) { | ||
const Polar point(i, stop.angle); | ||
display.setPoint(8 - point.y, 8 - point.x, HIGH); // translated to accomodate display orientation | ||
} | ||
} | ||
|
||
// measure along a full 90° turn, display, & print | ||
void sweep(const bool reverse = false) { | ||
|
||
// if reversed, step backward from end to start | ||
const int start = reverse ? 90 : 0; | ||
|
||
const int step = reverse | ||
? -settings::ultrasonic::angleStep | ||
: settings::ultrasonic::angleStep; | ||
|
||
display.clear(); | ||
|
||
// for each angle step in the 90° | ||
for (int angle = start; abs(angle - start) <= 90; angle += step) { | ||
|
||
// measure distance at the angle | ||
const Polar point = scanTo(angle); | ||
|
||
// display the measurement | ||
fillRadial(point); | ||
|
||
// format measurement for serial plotter | ||
char out[32]; | ||
sprintf(out, "direction:%01d radius:%02d x:%02d y:%02d", direction, point.radius, point.x, point.y); | ||
|
||
// format measurement as space-delimited CSV | ||
// char out[11] | ||
// sprintf(out, "%01d %02d %02d %02d", sweepDirection, point.radius, point.x, point.y); | ||
|
||
// print measurement | ||
Serial.println(out); | ||
} | ||
} | ||
|
||
// 🤖 -------------- 🤖 | ||
|
||
|
||
// ♾ Arduino functions ♾ | ||
|
||
void setup() { | ||
display.begin(); | ||
display.clear(); | ||
|
||
Serial.begin(9600); | ||
|
||
servo.attach(pins::servo); | ||
} | ||
|
||
void loop() { | ||
sweep(direction); | ||
direction = !direction; // flip | ||
} | ||
|
||
// ♾ ----------------- ♾ |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,11 @@ | ||
|
||
This directory is intended for PlatformIO Unit Testing and project tests. | ||
|
||
Unit Testing is a software testing method by which individual units of | ||
source code, sets of one or more MCU program modules together with associated | ||
control data, usage procedures, and operating procedures, are tested to | ||
determine whether they are fit for use. Unit testing finds problems early | ||
in the development cycle. | ||
|
||
More information about PlatformIO Unit Testing: | ||
- https://docs.platformio.org/page/plus/unit-testing.html |