From 9594f0e367bc4911b015df8dc704ce7ae9a5985c Mon Sep 17 00:00:00 2001
From: Sem van der Hoeven <semmer99@gmail.com>
Date: Wed, 31 Mar 2021 09:47:08 +0200
Subject: [PATCH] added skeleton for eindopdracht

---
 Microcontrollers/Eindopdracht/main.c | 28 +++++++++++++++++++++++++++-
 1 file changed, 27 insertions(+), 1 deletion(-)

diff --git a/Microcontrollers/Eindopdracht/main.c b/Microcontrollers/Eindopdracht/main.c
index f8f3ec8..1bd21ec 100644
--- a/Microcontrollers/Eindopdracht/main.c
+++ b/Microcontrollers/Eindopdracht/main.c
@@ -5,14 +5,40 @@
  * Author : Sem
  */ 
 
-#include <avr/io.h>
+#define F_CPU 10e6
 
+#include <avr/io.h>
+#include <util/delay.h>
+#include <avr/interrupt.h>
+
+#include "lcd_control.h"
+#include "ultrasonic_sensor.h"
+
+
+ISR(INT0_vect)
+{
+	ultrasonic_handle_interrupt();
+}
 
 int main(void)
 {
     /* Replace with your application code */
+	ultrasonic_init();
+	init_4bits_mode();
+	
+	_delay_ms(10);
+	
+	lcd_clear();
     while (1) 
     {
+		// TODO change to use the stepper motor
+		ultrasonic_send_pulse(); 
+		
+		lcd_clear();
+		lcd_write_int(ultrasonic_get_timer_dist());
+		
+		
+		wait_ms(100);
     }
 }