KRAI ITB GARUDAGO / Mbed 2 deprecated fungsi_switch_kaki

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed encoderKRAI Motornew CMPS12_KRAI ping millis

main.cpp@0:7ab5f1f9dcb8, 2019-02-06 (annotated)

Committer:
315_josh
Date:
Wed Feb 06 11:17:11 2019 +0000
Revision:
0:7ab5f1f9dcb8
Child:
1:a2c7dd0a0f6e
hcsr04 in disco

Who changed what in which revision?

UserRevisionLine numberNew contents of line
315_josh 0:7ab5f1f9dcb8 1 /* sensor : ultrasonic di depan kiri
315_josh 0:7ab5f1f9dcb8 2 sensor 2: ultrasonic di depan kanan
315_josh 0:7ab5f1f9dcb8 3 sensor 3: ultrasonic di belakang kiri
315_josh 0:7ab5f1f9dcb8 4 sensor 4: ultrasonic di belakang kanan
315_josh 0:7ab5f1f9dcb8 5 */
315_josh 0:7ab5f1f9dcb8 6
315_josh 0:7ab5f1f9dcb8 7 #include "mbed.h"
315_josh 0:7ab5f1f9dcb8 8 #include "hcsr04.h"
315_josh 0:7ab5f1f9dcb8 9 #include "RGBLed.h"
315_josh 0:7ab5f1f9dcb8 10 #include "LCD_DISCO_F429ZI.h"
315_josh 0:7ab5f1f9dcb8 11 //#include "string.h"
315_josh 0:7ab5f1f9dcb8 12
315_josh 0:7ab5f1f9dcb8 13 LCD_DISCO_F429ZI lcd;
315_josh 0:7ab5f1f9dcb8 14 //Serial pc (USBTX, USBRX,115200);
315_josh 0:7ab5f1f9dcb8 15
315_josh 0:7ab5f1f9dcb8 16
315_josh 0:7ab5f1f9dcb8 17 //D12 TRIGGER D11 ECHO
315_josh 0:7ab5f1f9dcb8 18 HCSR04 sensor(PA_4, PA_5);
315_josh 0:7ab5f1f9dcb8 19 HCSR04 sensor2(PC_4, PC_5);
315_josh 0:7ab5f1f9dcb8 20 // HCSR04 sensor3(PA4, PA5);
315_josh 0:7ab5f1f9dcb8 21 // HCSR04 sensor4(PA6, PA7);
315_josh 0:7ab5f1f9dcb8 22 // DigitalOut led1(PE_10);
315_josh 0:7ab5f1f9dcb8 23 // DigitalOut led2(PE_11);
315_josh 0:7ab5f1f9dcb8 24 // DigitalOut led3(PE_12);
315_josh 0:7ab5f1f9dcb8 25
315_josh 0:7ab5f1f9dcb8 26 int main() {
315_josh 0:7ab5f1f9dcb8 27 uint8_t text[10];
315_josh 0:7ab5f1f9dcb8 28 // led1=0;
315_josh 0:7ab5f1f9dcb8 29 // led2=0;
315_josh 0:7ab5f1f9dcb8 30 // led3=0;
315_josh 0:7ab5f1f9dcb8 31 long dkiri, dkanan;
315_josh 0:7ab5f1f9dcb8 32 BSP_LCD_SetFont(&Font20);
315_josh 0:7ab5f1f9dcb8 33 lcd.DisplayStringAt(0, LINE(5), (uint8_t *)"TOUCHSCREEN", CENTER_MODE);
315_josh 0:7ab5f1f9dcb8 34 lcd.DisplayStringAt(0, LINE(6), (uint8_t *)"INIT OK", CENTER_MODE);
315_josh 0:7ab5f1f9dcb8 35 wait(3);
315_josh 0:7ab5f1f9dcb8 36 while(1) {
315_josh 0:7ab5f1f9dcb8 37 BSP_LCD_SetFont(&Font20);
315_josh 0:7ab5f1f9dcb8 38 lcd.Clear(LCD_COLOR_BLACK);
315_josh 0:7ab5f1f9dcb8 39 lcd.SetBackColor(LCD_COLOR_BLACK);
315_josh 0:7ab5f1f9dcb8 40 lcd.SetTextColor(LCD_COLOR_WHITE);
315_josh 0:7ab5f1f9dcb8 41 dkiri = sensor.distance();
315_josh 0:7ab5f1f9dcb8 42 dkanan = sensor2.distance();
315_josh 0:7ab5f1f9dcb8 43 // bkiri = sensor3.distance();
315_josh 0:7ab5f1f9dcb8 44 // bkanan = sensor4.distance();
315_josh 0:7ab5f1f9dcb8 45 sprintf((char*)text, "i=%d a=%d", (int *)dkiri,(int *) dkanan);
315_josh 0:7ab5f1f9dcb8 46 lcd.DisplayStringAt(0, LINE(6), (uint8_t *)text, CENTER_MODE);
315_josh 0:7ab5f1f9dcb8 47 //lcd.DisplayStringAt(0, LINE(5), (uint8_t *)"distance front right %d\n", dkanan, CENTER_MODE);
315_josh 0:7ab5f1f9dcb8 48 /* pc.printf("distance front left %d\n",dkiri);
315_josh 0:7ab5f1f9dcb8 49 pc.printf("distance front right %d\n",dkanan);
315_josh 0:7ab5f1f9dcb8 50 pc.printf("distance back left %d\n",bkiri);
315_josh 0:7ab5f1f9dcb8 51 pc.printf("distance back left %d\n",bkanan);*/
315_josh 0:7ab5f1f9dcb8 52 // 1 sec
315_josh 0:7ab5f1f9dcb8 53 wait(0.3);
315_josh 0:7ab5f1f9dcb8 54 /* if ((dkanan >=150) || (dkiri>=150))
315_josh 0:7ab5f1f9dcb8 55 {
315_josh 0:7ab5f1f9dcb8 56 led1 = 1;
315_josh 0:7ab5f1f9dcb8 57 udhbelok = 1;
315_josh 0:7ab5f1f9dcb8 58 }
315_josh 0:7ab5f1f9dcb8 59 if ((udhbelok==1) && (bkanan >= 100))
315_josh 0:7ab5f1f9dcb8 60 {
315_josh 0:7ab5f1f9dcb8 61 led1 = 0;
315_josh 0:7ab5f1f9dcb8 62 led3 = 1;
315_josh 0:7ab5f1f9dcb8 63 } */
315_josh 0:7ab5f1f9dcb8 64 }
315_josh 0:7ab5f1f9dcb8 65 }