Diff: HCSR04/SONAR_MANAGER.cpp

Revision:

3:a4677501ae87

Parent:

2:0de4854743f7

diff -r 0de4854743f7 -r a4677501ae87 HCSR04/SONAR_MANAGER.cpp
--- a/HCSR04/SONAR_MANAGER.cpp	Thu Jun 10 01:23:00 2021 +0000
+++ b/HCSR04/SONAR_MANAGER.cpp	Tue Nov 30 08:13:05 2021 +0000
@@ -1,61 +0,0 @@
-#include "SONAR_MANAGER.hpp"
-//extern mbed::Serial pc;
-SONAR_MANAGER::SONAR_MANAGER(PinName trigger_pin, HCSR04* sonar_array, size_t num_sonar_) : 
-trigger(trigger_pin), sonar(sonar_array), num_sonar(num_sonar_)
-{}
-
-void SONAR_MANAGER::Begin(float control_freq_)
-{
-    control_freq = control_freq_;
-    for(int i = 0; i < num_sonar; i++)
-    {
-        sonar[i].setRanges(3, 70);
-    }
-    distance.assign(num_sonar, 0);
-    scheduler.attach(callback(this, &SONAR_MANAGER::Loop), float(1.0 / control_freq));
-    memset(ready,0,sizeof(ready));
-}
-
-void SONAR_MANAGER::Loop()
-{
-    int i;
-    memset(ready,0,sizeof(ready));
-    trigger = 1;
-    triggerTimeout.attach_us(callback(this, &SONAR_MANAGER::turnOffTrigger), 10);
-    for(i = 0; i < num_sonar; i++)
-    {
-        ready[i] = sonar[i].isNewDataReady();
-        sonar[i].startMeasurement();
-        if(ready[i] != 0)
-        {   
-            distance[i] = sonar[i].getDistance_cm();
-        } 
-    }
-}
-
-void SONAR_MANAGER::GetDistance(volatile float dest[])
-{
-    for(int i = 0; i < num_sonar; i++)
-    {
-        dest[i] = distance[i];
-    }
-}
-
-void SONAR_MANAGER::turnOffTrigger()
-{
-    trigger = 0;
-}
-/*
-void SONAR_MANAGER::PrintReady()
-{
-    
-    pc.printf("\rdata ready: \n\r");
-    for(int i = 0; i < num_sonar; i++)
-    {
-        pc.printf("%d ",ready[i]);
-    }
-    pc.printf("\n\r");
-}
-*/
-
-/* SONAR_MANAGER.cpp */