Diff: main.cpp

Revision:

0:7ab5f1f9dcb8

Child:

1:a2c7dd0a0f6e

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Feb 06 11:17:11 2019 +0000
@@ -0,0 +1,65 @@
+/*  sensor  : ultrasonic di depan kiri
+    sensor 2: ultrasonic di depan kanan
+    sensor 3: ultrasonic di belakang kiri
+    sensor 4: ultrasonic di belakang kanan
+*/
+
+#include "mbed.h"
+#include "hcsr04.h"
+#include "RGBLed.h"
+#include "LCD_DISCO_F429ZI.h"
+//#include "string.h"
+
+LCD_DISCO_F429ZI lcd;
+//Serial pc (USBTX, USBRX,115200);
+
+
+//D12 TRIGGER D11 ECHO
+   HCSR04 sensor(PA_4, PA_5); 
+   HCSR04 sensor2(PC_4, PC_5);
+  // HCSR04 sensor3(PA4, PA5);
+  // HCSR04 sensor4(PA6, PA7);
+ //  DigitalOut led1(PE_10);
+ //  DigitalOut led2(PE_11); 
+ //  DigitalOut led3(PE_12);
+
+int main() {
+    uint8_t text[10];
+   // led1=0;
+   // led2=0;
+   // led3=0;
+    long dkiri, dkanan;
+        BSP_LCD_SetFont(&Font20);
+      lcd.DisplayStringAt(0, LINE(5), (uint8_t *)"TOUCHSCREEN", CENTER_MODE);
+      lcd.DisplayStringAt(0, LINE(6), (uint8_t *)"INIT OK", CENTER_MODE);
+      wait(3);
+    while(1) {
+    BSP_LCD_SetFont(&Font20);
+    lcd.Clear(LCD_COLOR_BLACK);
+      lcd.SetBackColor(LCD_COLOR_BLACK);
+      lcd.SetTextColor(LCD_COLOR_WHITE);
+      dkiri  = sensor.distance();
+      dkanan = sensor2.distance();
+    //  bkiri  = sensor3.distance();
+     // bkanan = sensor4.distance();   
+      sprintf((char*)text, "i=%d a=%d", (int *)dkiri,(int *) dkanan);
+      lcd.DisplayStringAt(0, LINE(6), (uint8_t *)text, CENTER_MODE);
+     //lcd.DisplayStringAt(0, LINE(5), (uint8_t *)"distance front right %d\n", dkanan, CENTER_MODE);
+         /* pc.printf("distance front left  %d\n",dkiri);
+          pc.printf("distance front right  %d\n",dkanan);
+          pc.printf("distance back left  %d\n",bkiri);
+          pc.printf("distance back left  %d\n",bkanan);*/
+ // 1 sec  
+      wait(0.3);
+    /*  if ((dkanan >=150) || (dkiri>=150))
+        {
+          led1 = 1;
+          udhbelok = 1;
+        }
+      if ((udhbelok==1) && (bkanan >= 100))
+        {
+          led1 = 0;
+          led3 = 1;
+        } */
+    }
+}
\ No newline at end of file