diff --git a/main.py b/main.py
index 5539baa..ad6c9c8 100644
--- a/main.py
+++ b/main.py
@@ -4,9 +4,19 @@ from datetime import datetime
 try:
     import paho.mqtt.client as mqtt
     import gpiozero
+    global GPIO
+    import RPi.GPIO as GPIO
 except ImportError:
     print('Some modules are missing. Try to install them with "pip3 install -r requirements.txt"')
     exit()
+GPIO.setmode(GPIO.BCM)
+
+# setting up ultrasonic pins
+GPIO_TRIGGER = 18
+GPIO_ECHO = 24
+GPIO.setup(GPIO_TRIGGER, GPIO.OUT)
+GPIO.setup(GPIO_ECHO, GPIO.IN)
+
 
 def debug_print(message: str):
     now = datetime.now()
@@ -28,5 +38,21 @@ def relay_controller(pin: int, status: str):
     else:
         error_print("Unknown status for relay ("+status+")")
 
-def get_water_lvl():
-    
\ No newline at end of file
+def get_water_level():
+    GPIO.output(GPIO_TRIGGER, True)
+    time.sleep(0.00001)
+    GPIO.output(GPIO_TRIGGER, False)
+ 
+    startTime = time.time()
+    StopTime = time.time()
+ 
+    while GPIO.input(GPIO_ECHO) == 0:
+        startTime = time.time()
+    while GPIO.input(GPIO_ECHO) == 1:
+        StopTime = time.time()
+ 
+    TimeElapsed = StopTime - startTime
+    distance = (TimeElapsed * 34300) / 2
+ 
+    return distance
+