Adding wave_detection_sm.py, It is an SM that detects subscribes to the ...

...wave_detector topic, and returns the wave position