Skip to content

Commit

Permalink
first commit
Browse files Browse the repository at this point in the history
  • Loading branch information
solanto committed Apr 24, 2021
0 parents commit b630891
Show file tree
Hide file tree
Showing 7 changed files with 306 additions and 0 deletions.
5 changes: 5 additions & 0 deletions .gitignore
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
7 changes: 7 additions & 0 deletions .vscode/extensions.json
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"
]
}
39 changes: 39 additions & 0 deletions include/README
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
46 changes: 46 additions & 0 deletions lib/README
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
18 changes: 18 additions & 0 deletions platformio.ini
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
180 changes: 180 additions & 0 deletions src/main.cpp
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
}

// ♾ ----------------- ♾
11 changes: 11 additions & 0 deletions test/README
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

0 comments on commit b630891

Please sign in to comment.