From 791906560d0476e557a2c56f98ada5ef5aeb1b94 Mon Sep 17 00:00:00 2001
From: Henrique Martinez <rocamora.henrique@gmail.com>
Date: Wed, 8 Jan 2020 09:24:03 +0100
Subject: [PATCH 1/2] removed debug windows (not necessay anymore)

---
 src/ping360_sonar/node.py | 5 -----
 1 file changed, 5 deletions(-)

diff --git a/src/ping360_sonar/node.py b/src/ping360_sonar/node.py
index 4fe3797..9f6eed2 100644
--- a/src/ping360_sonar/node.py
+++ b/src/ping360_sonar/node.py
@@ -110,11 +110,6 @@ def main():
                continue
           
           angle = (angle + step) % 400
-          if debug:
-               cv2.imshow("PolarPlot",image)
-               cv2.waitKey(1)
-          else:
-               cv2.destroyAllWindows()
           publishImage(image, imagePub, bridge)
           rate.sleep()
 

From cc35848e823c2472b17cba9513a253cc569bbfe1 Mon Sep 17 00:00:00 2001
From: Stormiix <madadj4@gmail.com>
Date: Wed, 8 Jan 2020 09:52:50 +0100
Subject: [PATCH 2/2] [Fix] Serial opens on rostopic echo  #18

---
 launch/example.launch     |  4 ++--
 src/ping360_sonar/node.py | 36 ++++++++++++++++++------------------
 2 files changed, 20 insertions(+), 20 deletions(-)

diff --git a/launch/example.launch b/launch/example.launch
index 25392d1..2236c96 100644
--- a/launch/example.launch
+++ b/launch/example.launch
@@ -1,9 +1,9 @@
 <launch>
-    <env name="emulated_sonar" value="true" />
+    <env name="emulated_sonar" value="false" />
     <node pkg="ping360_sonar" type="ping360_node" name="ping360_node" output="screen">
         <param name="device" value="/dev/ttyUSB0"/>
         <param name="baudrate" value="115200"/>
-        <param name="debug" value="True"/>
+        <param name="debug" value="False"/>
         <param name="imgSize" value="500"/>
         <param name="gain" value="0"/>
         <param name="step" value="1"/>
diff --git a/src/ping360_sonar/node.py b/src/ping360_sonar/node.py
index 9f6eed2..b96decd 100644
--- a/src/ping360_sonar/node.py
+++ b/src/ping360_sonar/node.py
@@ -19,7 +19,7 @@
 
 
 def callback(config, level):
-     global updated, gain, numberOfSamples, transmitFrequency, transmitDuration, sonarRange, speedOfSound, samplePeriod, debug, step, imgSize, queue_size, p, threshold
+     global updated, gain, numberOfSamples, transmitFrequency, transmitDuration, sonarRange, speedOfSound, samplePeriod, debug, step, imgSize, queue_size, threshold
      # Update Ping 360 Parameters
      gain = config['gain']
      numberOfSamples = config['numberOfSamples']
@@ -37,6 +37,9 @@ def callback(config, level):
      return config
 
 def main():
+     sensor = Ping360(device, baudrate)
+     print("Initialized: %s" % sensor.initialize())
+     
      rospy.init_node('ping360_node')
      srv = Server(sonarConfig, callback)
 
@@ -50,7 +53,7 @@ def main():
      laserPub = rospy.Publisher("/ping360_node/sonar/scan", LaserScan, queue_size=queue_size)
 
      # Initialize and configure the sonar
-     updateSonarConfig(gain, transmitFrequency, transmitDuration, samplePeriod, numberOfSamples)
+     updateSonarConfig(sensor, gain, transmitFrequency, transmitDuration, samplePeriod, numberOfSamples)
 
      # Create a new mono-channel image
      image = np.zeros((imgSize, imgSize, 1), np.uint8)
@@ -66,13 +69,12 @@ def main():
      rate = rospy.Rate(100) # 100hz
      
      while not rospy.is_shutdown():
-          
           # Update to the latest config data
           if updated:
-               updateSonarConfig(gain, transmitFrequency, transmitDuration, samplePeriod, numberOfSamples)
+               updateSonarConfig(sensor, gain, transmitFrequency, transmitDuration, samplePeriod, numberOfSamples)
           
           # Get sonar response
-          data = getSonarData(angle)
+          data = getSonarData(sensor, angle)
           
           # Contruct and publish Sonar data msg
           rawDataMsg = generateRawMsg(angle, data) # TODO: check for empty responses
@@ -113,16 +115,17 @@ def main():
           publishImage(image, imagePub, bridge)
           rate.sleep()
 
-def getSonarData(angle):
+def getSonarData(sensor, angle):
      """
      Transmits the sonar angle and returns the sonar intensities
      Params:
+          sensor  Ping360 (Sensor class)
           angle int (Gradian Angle)
      Return:
           data list Intensities from 0 - 255 
      """
-     p.transmitAngle(angle)
-     data = bytearray(getattr(p,'_data'))
+     sensor.transmitAngle(angle)
+     data = bytearray(getattr(sensor,'_data'))
      return [k for k in data]
 
 def generateRawMsg(angle, data):
@@ -220,13 +223,13 @@ def getSamplePeriod(samplePeriod, _samplePeriodTickDuration = 25e-9):
      """  Sample period in ns """
      return samplePeriod * _samplePeriodTickDuration
 
-def updateSonarConfig(gain, transmitFrequency, transmitDuration, samplePeriod, numberOfSamples):
+def updateSonarConfig(sensor, gain, transmitFrequency, transmitDuration, samplePeriod, numberOfSamples):
      global updated
-     p.set_gain_setting(gain)
-     p.set_transmit_frequency(transmitFrequency)
-     p.set_transmit_duration(transmitDuration)
-     p.set_sample_period(samplePeriod)
-     p.set_number_of_samples(numberOfSamples)
+     sensor.set_gain_setting(gain)
+     sensor.set_transmit_frequency(transmitFrequency)
+     sensor.set_transmit_duration(transmitDuration)
+     sensor.set_sample_period(samplePeriod)
+     sensor.set_number_of_samples(numberOfSamples)
      updated = False
 
 # Ping 360 Parameters
@@ -248,7 +251,4 @@ def updateSonarConfig(gain, transmitFrequency, transmitDuration, samplePeriod, n
 step = rospy.get_param('~step', 1)
 imgSize = rospy.get_param('~imgSize', 500)
 queue_size= rospy.get_param('~queueSize', 1)
-
-p = Ping360(device, baudrate)
-updated = False
-print("Initialized: %s" % p.initialize())
+updated = False
\ No newline at end of file