mirror of
https://github.com/NolanMascrier/arduino.git
synced 2025-10-30 07:16:00 +00:00
140 lines
3.0 KiB
C++
140 lines
3.0 KiB
C++
/*
|
|
APDS-9960 - Proximity Sensor
|
|
|
|
This example reads proximity data from the on-board APDS-9960 sensor of the
|
|
Nano 33 BLE Sense and prints the proximity value to the Serial Monitor
|
|
every 100 ms.
|
|
|
|
The circuit:
|
|
- Arduino Nano 33 BLE Sense
|
|
|
|
This example code is in the public domain.
|
|
*/
|
|
|
|
#include <Arduino_APDS9960.h>
|
|
//#include <WiFiNINA.h>
|
|
#include "arduino_secrets.h"
|
|
|
|
#define TRIGG_BOTTOM D12
|
|
#define TRIGG_TOP D10
|
|
#define TRIGG_1 D8
|
|
#define TRIGG_2 A0
|
|
#define TRIGG_3 A2
|
|
#define TRIGG_4 A4
|
|
|
|
#define ECHO_BOTTOM D11
|
|
#define ECHO_TOP D9
|
|
#define ECHO_1 D7
|
|
#define ECHO_2 A1
|
|
#define ECHO_3 A3
|
|
#define ECHO_4 A5
|
|
|
|
#define STATUS_SAFE 0
|
|
#define STATUS_CLOSE 1
|
|
#define STATUS_DANGER 2
|
|
|
|
#define DISTANCE_DANGER 40
|
|
#define DISTANCE_SAFE 120
|
|
|
|
int status = STATUS_SAFE;
|
|
//int wifi_status = WL_IDLE_STATUS;
|
|
|
|
int ledState = LOW;
|
|
|
|
//please enter your sensitive data in the Secret tab
|
|
char ssid[] = SECRET_SSID; // your network SSID (name)
|
|
char pass[] = SECRET_PASS; // your network password (use for WPA, or use as key for WEP)
|
|
|
|
unsigned long previousMillis = 0;
|
|
|
|
const long intervalLong = 750;
|
|
const long intervalMedLo = 250;
|
|
const long intervalMed = 150;
|
|
const long intervalMedSho = 80;
|
|
const long intervalShort = 20;
|
|
|
|
const int trigger = 12;
|
|
const int echo = 11;
|
|
|
|
int count = 0;
|
|
|
|
long duration = 0;
|
|
int distance = 0;
|
|
|
|
long durations[6];
|
|
long distances[6];
|
|
|
|
void setup() {
|
|
Serial.begin(9600);
|
|
Serial.println("Starting up");
|
|
|
|
if (!APDS.begin()) {
|
|
Serial.println("Error initializing APDS-9960 sensor!");
|
|
while (1);
|
|
}
|
|
pinMode(LED_BUILTIN, OUTPUT);
|
|
|
|
//Init the sensors
|
|
pinMode(TRIGG_BOTTOM, OUTPUT);
|
|
pinMode(TRIGG_TOP, OUTPUT);
|
|
pinMode(TRIGG_1, OUTPUT);
|
|
pinMode(TRIGG_2, OUTPUT);
|
|
pinMode(TRIGG_3, OUTPUT);
|
|
pinMode(TRIGG_4, OUTPUT);
|
|
|
|
pinMode(ECHO_BOTTOM, INPUT);
|
|
pinMode(ECHO_TOP, INPUT);
|
|
pinMode(ECHO_1, INPUT);
|
|
pinMode(ECHO_2, INPUT);
|
|
pinMode(ECHO_3, INPUT);
|
|
pinMode(ECHO_4, INPUT);
|
|
}
|
|
|
|
/**
|
|
* Reads the data from the sensor and calculates the distance.
|
|
*
|
|
* @return calculated distance.
|
|
*/
|
|
long fire_sensor(int trigger, int echo)
|
|
{
|
|
long dist;
|
|
long dur;
|
|
|
|
digitalWrite(trigger, LOW);
|
|
delayMicroseconds(2);
|
|
digitalWrite(trigger, HIGH);
|
|
delayMicroseconds(10);
|
|
digitalWrite(trigger, LOW);
|
|
dur = pulseIn(echo, HIGH);
|
|
dist = dur * 0.034 / 2;
|
|
delay(50);
|
|
return (dist);
|
|
}
|
|
|
|
void loop() {
|
|
unsigned long currentMillis = millis();
|
|
|
|
Serial.print("Measure number ");
|
|
Serial.println(count);
|
|
distances[0] = fire_sensor(TRIGG_BOTTOM, ECHO_BOTTOM);
|
|
distances[1] = fire_sensor(TRIGG_TOP, ECHO_TOP);
|
|
distances[2] = fire_sensor(TRIGG_1, ECHO_1);
|
|
distances[3] = fire_sensor(TRIGG_2, ECHO_2);
|
|
distances[4] = fire_sensor(TRIGG_3, ECHO_3);
|
|
distances[5] = fire_sensor(TRIGG_4, ECHO_4);
|
|
|
|
for (int i = 0; i < 6; i++)
|
|
{
|
|
Serial.print("Sensor {");
|
|
Serial.print(i);
|
|
Serial.print("} : ");
|
|
Serial.print(distances[i]);
|
|
Serial.println("cm");
|
|
}
|
|
//update_status(distance);
|
|
|
|
// wait a bit before reading again
|
|
delayMicroseconds(1000000);
|
|
count++;
|
|
}
|