10/29/20 12:23
Dependencies: mbed DRV2605 HCSR04 HC_SR04_Ultrasonic_Library
main.cpp
- Committer:
- jmalone37
- Date:
- 2020-11-02
- Revision:
- 4:111b818ede8c
- Parent:
- 3:ab0d9d3ae4d4
File content as of revision 4:111b818ede8c:
//Theremin style demo using HC-SR04 Sonar and vibrating motors // moving a hand away/towards sonar changes vibrational frequency #include "mbed.h" #include "ultrasonic.h" #include "DRV2605.h" //#include "hcsr04.h" //DRV2605 haptics(p9, p10); I2C i2c1(p9, p10); I2C i2c2(p28, p27); bool isERM = true; DRV2605 hap1(i2c1); DRV2605 hap2(i2c2); //HCSR04 sensor1(p7, p8); //Timeout cycle; //ultrasonic mu(p7, p8, .07, 1, &newdist); //volatile int half_cycle_time = 1; //two calls to this interrupt routine generates a square wave //void toggle_interrupt() //{ // getCurrentDistance(0)=distance; /*if (half_cycle_time>22000) haptics.play_waveform(0); else { static int e1 = 1; haptics.play_waveform(e1); e1+=10; if(e1 > 121) e1 = 1; } led = !led;*/ //cycle.detach(); //update time for interrupt activation -change frequency of square wave //cycle.attach_us(&toggle_interrupt, half_cycle_time); //} /* void newdist(int distance) { //update frequency based on new sonar data led2 = !led2; half_cycle_time = distance<<3; } */ //HC-SR04 Sonar module // ultrasonic mu(p7, p8, .07, 1, &newdist); //Set the trigger pin to p6 and the echo pin to p7 //have updates every .07 seconds and a timeout after 1 //second, and call newdist when the distance changes void dist(int distance) { //put code here to execute when the distance has changed if (distance > 10) { hap1.setWaveform(0); hap1.playRtp(10); } else if (distance > 25) { hap1.setWaveform(0); hap1.playRtp(25); } //printf("Distance %d mm\r\n", distance); } ultrasonic mu(p7, p8, .1, 1, &dist); //Set the trigger pin to p6 and the echo pin to p7 //have updates every .1 seconds and a timeout after 1 //second, and call dist when the distance changes int main() { mu.startUpdates();//start measuring the distance while(1) { //Do something else here mu.checkDistance(); //call checkDistance() as much as possible, as this is where //the class checks if dist needs to be called. } } /*int main() { while(1) { long distance = sensor1.distance(); if (distance > 10) { hap1.setWaveform(0); hap1.playRtp(10); } else if (distance > 25) { hap1.setWaveform(0); hap1.playRtp(100); } //printf("distance %d \n",distance); // wait(1.0); // 1 sec } } */