ported to CircuitPython
This commit is contained in:
parent
6f80c78d4e
commit
358a2c5f4b
3 changed files with 260 additions and 0 deletions
4
Trinket_Ultrasonic_Rangefinder/README.md
Normal file
4
Trinket_Ultrasonic_Rangefinder/README.md
Normal file
|
|
@ -0,0 +1,4 @@
|
|||
# Trinket_Ultrasonic_Rangefinder
|
||||
|
||||
Code to accompany this tutorial:
|
||||
https://learn.adafruit.com/trinket-ultrasonic-rangefinder
|
||||
|
|
@ -0,0 +1,114 @@
|
|||
/*
|
||||
Demonstration sketch for Adafruit LCD backpack
|
||||
using MCP23008 I2C expander and Maxbotic LV-EZ1 Ultrasonic Sensor
|
||||
(other pin compatible Maxbotix sensors should also work)
|
||||
Tested with the 5 volt Trinket mini microcontroller at 8 MHz
|
||||
The ultrasonic sensor and pin use should be Gemma and Trinket 3V compatible
|
||||
|
||||
This sketch reads the LV-EZ1 by pulse count and prints the distance to the LCD
|
||||
|
||||
The circuit:
|
||||
* 5V to Arduino 5V pin, I2C Backpack 5V and EZ1 +5
|
||||
* GND to Arduino GND pin, I2C Backpack GND and EZ1 GND
|
||||
* Display I2C Backpack CLK to Trinket GPIO #2
|
||||
* Display I2C backpack DAT to Trinket GPIO #0
|
||||
* LV-EZ1 Ultrasonic Sensor PW pin to Trinket GPIO #1
|
||||
|
||||
Portions of code provided free use on http://playground.arduino.cc/Main/MaxSonar
|
||||
by Bruce Allen and Bill Gentles
|
||||
|
||||
Version 2.0 Adds Arduino IDE 1.6.7 and greater Wire support
|
||||
Mike Barela for Adafruit Industries
|
||||
*/
|
||||
|
||||
// include the library code
|
||||
#include <Adafruit_LiquidCrystal.h> // Tiny LiquidCrystal library using TinyWireM
|
||||
|
||||
#define EZ1pin 1 // Trinket GPIO #1
|
||||
|
||||
// Connect display via i2c, default address #0 (A0-A2 not jumpered)
|
||||
Adafruit_LiquidCrystal lcd(0);
|
||||
|
||||
// These values are for calculating a mathematical median for a number of samples as
|
||||
// suggested by Maxbotix instead of a mathematical average
|
||||
int8_t arraysize = 9; // quantity of values to find the median (sample size). Needs to be an odd number
|
||||
//declare an array to store the samples. not necessary to zero the array values here, it just makes the code clearer
|
||||
uint16_t rangevalue[] = { 0, 0, 0, 0, 0, 0, 0, 0, 0};
|
||||
uint16_t modE; // calculated median distance
|
||||
|
||||
void setup() {
|
||||
pinMode(EZ1pin, INPUT); // Sey ultrasonic sensor pin as input
|
||||
lcd.begin(16, 2); // set up the LCD number of rows and columns:
|
||||
lcd.setBacklight(HIGH); // Set backlight on (HIGH on, LOW off)
|
||||
}
|
||||
|
||||
void loop() {
|
||||
int16_t pulse; // number of pulses from sensor
|
||||
int i=0;
|
||||
|
||||
while( i < arraysize )
|
||||
{
|
||||
pulse = pulseIn(EZ1pin, HIGH); // read in time for pin to transition
|
||||
rangevalue[i]=pulse/58; // pulses to centimeters (use 147 for inches)
|
||||
if( rangevalue[i] < 645 && rangevalue[i] >= 15 ) i++; // ensure no values out of range
|
||||
delay(10); // wait between samples
|
||||
}
|
||||
isort(rangevalue,arraysize); // sort samples
|
||||
modE = mode(rangevalue,arraysize); // get median
|
||||
|
||||
lcd.setCursor(0, 0); // write data to LCD display via I2C backpack
|
||||
lcd.print("Range: "); // write to LCD
|
||||
lcd.setCursor(7,0);
|
||||
lcd.print(" ");
|
||||
lcd.setCursor(7,0);
|
||||
lcd.print(modE);
|
||||
lcd.setCursor(11,0);
|
||||
lcd.print("cm");
|
||||
|
||||
delay(500); // Read every half second
|
||||
}
|
||||
|
||||
// Sorting function (Author: Bill Gentles, Nov. 12, 2010)
|
||||
void isort(uint16_t *a, int8_t n){
|
||||
for (int i = 1; i < n; ++i) {
|
||||
uint16_t j = a[i];
|
||||
int k;
|
||||
for (k = i - 1; (k >= 0) && (j < a[k]); k--) {
|
||||
a[k + 1] = a[k];
|
||||
}
|
||||
a[k + 1] = j;
|
||||
}
|
||||
}
|
||||
|
||||
// Mode function, returning the mode or median.
|
||||
uint16_t mode(uint16_t *x,int n){
|
||||
int i = 0;
|
||||
int count = 0;
|
||||
int maxCount = 0;
|
||||
uint16_t mode = 0;
|
||||
int bimodal;
|
||||
int prevCount = 0;
|
||||
while(i<(n-1)){
|
||||
prevCount=count;
|
||||
count=0;
|
||||
while( x[i]==x[i+1] ) {
|
||||
count++;
|
||||
i++;
|
||||
}
|
||||
if( count > prevCount & count > maxCount) {
|
||||
mode=x[i];
|
||||
maxCount=count;
|
||||
bimodal=0;
|
||||
}
|
||||
if( count == 0 ) {
|
||||
i++;
|
||||
}
|
||||
if( count == maxCount ) { //If the dataset has 2 or more modes.
|
||||
bimodal=1;
|
||||
}
|
||||
if( mode==0 || bimodal==1 ) { // Return the median if there is no mode.
|
||||
mode=x[(n/2)];
|
||||
}
|
||||
return mode;
|
||||
}
|
||||
}
|
||||
142
Trinket_Ultrasonic_Rangefinder/Trinket_Ultrasonic_Rangefinder.py
Normal file
142
Trinket_Ultrasonic_Rangefinder/Trinket_Ultrasonic_Rangefinder.py
Normal file
|
|
@ -0,0 +1,142 @@
|
|||
# This Code uses the:
|
||||
# * Adafruit LCD backpack using MCP23008 I2C expander
|
||||
# * Maxbotic LV-EZ1 Ultrasonic Sensor
|
||||
#
|
||||
# Tested with the Trinket M0
|
||||
# The ultrasonic sensor and pin use should be Gemma M0 compatible
|
||||
# This sketch reads the LV-EZ1 by pulse count
|
||||
# Then prints the distance to the LCD and python console
|
||||
#
|
||||
# The circuit:
|
||||
# * 5V to Trinket M0 USB or BAT pin, I2C Backpack 5V and EZ1 +5
|
||||
# * GND to Trinket M0 GND pin, I2C Backpack GND and EZ1 GND
|
||||
# * Display I2C Backpack SLK to Trinket GPIO #2
|
||||
# * Display I2C backpack SDA to Trinket GPIO #0
|
||||
# * LV-EZ1 Ultrasonic Sensor PW pin to Trinket GPIO #1
|
||||
# * Backlight can be hard wired by connecting LCD pin 16, 17 or 18 to GND
|
||||
|
||||
import board
|
||||
import busio
|
||||
import time
|
||||
import pulseio
|
||||
import adafruit_character_lcd
|
||||
|
||||
ez1pin = board.D1 # Trinket GPIO #1
|
||||
|
||||
# i2c LCD initialize bus and class
|
||||
i2c = busio.I2C(board.SCL, board.SDA)
|
||||
cols = 16
|
||||
rows = 2
|
||||
lcd = adafruit_character_lcd.Character_LCD_I2C(i2c, cols, rows)
|
||||
|
||||
# calculated mode or median distance
|
||||
mode_result = 0
|
||||
|
||||
# pulseio can store multiple pulses
|
||||
# read in time for pin to transition
|
||||
samples = 18
|
||||
pulses = pulseio.PulseIn(board.D1, maxlen=samples)
|
||||
|
||||
# sensor reads which are in range will be stored here
|
||||
rangevalue = [0, 0, 0, 0, 0, 0, 0, 0, 0]
|
||||
|
||||
# 25ms sensor power up pause
|
||||
time.sleep(.25)
|
||||
|
||||
# EZ1 ultrasonic sensor is measuring "time of flight"
|
||||
# * convert time of flight into distance
|
||||
# * centimeters (divide by 58mS)
|
||||
# * inches (divide by 147mS)
|
||||
# * centimeter is default output, flip comments for inches
|
||||
def tof_to_distance(tof):
|
||||
# convert_to_inches = 147
|
||||
convert_to_cm = 58
|
||||
|
||||
# inches = tof / convert_to_inches
|
||||
cm = tof / convert_to_cm
|
||||
|
||||
# return inches
|
||||
return cm
|
||||
|
||||
# find the mode (most common value reported)
|
||||
# will return median (center of sorted list)
|
||||
# should mode not be found
|
||||
def mode(x, n):
|
||||
|
||||
maxcount = 0
|
||||
mode = 0
|
||||
bimodal = 0
|
||||
prevcount = 0
|
||||
counter = 0
|
||||
i = 0
|
||||
|
||||
while ( i < ( n - 1 ) ):
|
||||
prevcount = counter
|
||||
counter = 0
|
||||
|
||||
while ( ( x[i] ) == ( x[i+1] ) ):
|
||||
counter += 1
|
||||
i += 1
|
||||
|
||||
if ( ( counter > prevcount ) and ( counter > maxcount ) ):
|
||||
mode = x[i]
|
||||
maxcount = counter
|
||||
bimodal = 0
|
||||
|
||||
if ( counter == 0 ):
|
||||
i += 1
|
||||
|
||||
# If the dataset has 2 or more modes.
|
||||
if ( counter == maxcount ):
|
||||
bimodal = 1
|
||||
|
||||
# Return the median if there is no mode.
|
||||
if ( ( mode == 0 ) or ( bimodal == 1 ) ):
|
||||
mode = x [ int ( n / 2 ) ]
|
||||
|
||||
return mode
|
||||
|
||||
while True:
|
||||
|
||||
# wait between samples
|
||||
time.sleep(.5)
|
||||
|
||||
if ( len(pulses) == samples ):
|
||||
j = 0 # rangevalue array counter
|
||||
|
||||
# only save the values within range
|
||||
# range readings take 49mS
|
||||
# pulse width is .88mS to 37.5mS
|
||||
for i in range( 0, samples ):
|
||||
tof = pulses[i] # time of flight - PWM HIGH
|
||||
|
||||
if ( ( tof > 880 ) and ( tof < 37500 ) ):
|
||||
if ( j < len(rangevalue) ):
|
||||
rangevalue[j] = tof_to_distance(tof)
|
||||
j += 1
|
||||
|
||||
|
||||
# clear pulse samples
|
||||
pulses.clear() # clear all values in pulses[]
|
||||
|
||||
# sort samples
|
||||
rangevalue = sorted(rangevalue)
|
||||
|
||||
# returns mode or median
|
||||
mode_result = int(mode(rangevalue, len(rangevalue)))
|
||||
|
||||
# python console prints both centimeter and inches distance
|
||||
cm2in = .393701
|
||||
mode_result_in = mode_result * cm2in
|
||||
print(mode_result, "cm", "\t\t", int(mode_result_in), "in")
|
||||
|
||||
# result must be in char/string format for LCD printing
|
||||
digit_string = str(mode_result)
|
||||
|
||||
lcd.clear()
|
||||
lcd.message("Range: ") # write to LCD
|
||||
lcd.message(" ")
|
||||
lcd.message(digit_string)
|
||||
lcd.message("cm")
|
||||
|
||||
time.sleep(2)
|
||||
Loading…
Reference in a new issue