File content as of revision 0:7ab5f1f9dcb8:

/*  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;
        } */
    }
}