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  
        
    }
} */