Memrogram Robot Robogue Pico v2

Hari ketiga ini saya bersama 2 kawan saya diajarin memrogram Robot Robogue Pico v2 dengan Arduino.Dalam praktik ini saya dkk memrogram robot untuk menjadikan robot itu maju,mundur,belok kiri,belok kanan,memutar ke kiri dan memutar kekanan.



Untuk alat dan bahan masih seperti praktik sebelumnya
Dan Hari ini saya menggunakan beberapa coding seperti berikut :


//pinMotor
//roda kiri
#define gasKiri 5
#define setirKiri 4
//roda kanan
#define gasKanan 6
#define setirKanan 7

coding ini digunakan untuk mendefinisikan port port yang dipakai di Arduino

void setMotor(){

  pinMode(gasKiri,OUTPUT);

  pinMode(gasKanan,OUTPUT);

  pinMode(gasKiri,OUTPUT);

  pinMode(gasKanan,OUTPUT);

}

void maju (){

analogWrite(gasKiri,255);

digitalWrite(setirKiri,HIGH);

analogWrite(gasKanan,255);

digitalWrite(setirKanan,HIGH);

}

void mundur (){

analogWrite(gasKiri,255);

digitalWrite(setirKiri,LOW);

analogWrite(gasKanan,255);

digitalWrite(setirKanan,LOW);

}

void rotasiKanan (){

analogWrite(gasKiri,255);

digitalWrite(setirKiri,HIGH);

analogWrite(gasKanan,255);

digitalWrite(setirKanan,LOW);

}

void rotasiKiri (){

analogWrite(gasKiri,255);

digitalWrite(setirKiri,LOW);

analogWrite(gasKanan,255);

digitalWrite(setirKanan,HIGH);

}

void rem () {

digitalWrite(gasKanan,0);

digitalWrite(gasKiri,0);

}

void belokKiri (){

analogWrite(gasKiri,255/2);

digitalWrite(setirKiri,HIGH);

analogWrite(gasKanan,255);

digitalWrite(setirKanan,HIGH);

}

void belokKanan (){

analogWrite(gasKiri,255);

digitalWrite(setirKiri,HIGH);

analogWrite(gasKanan,255/2);

digitalWrite(setirKanan,HIGH);

}

coding ini digunakan untuk memberikanperintah kepada robot untuk maju,mundur,belok dll

#include <NewPing.h>

#include "pinMotor.h"

NewPing sensor(9,10,200);

void setup() {

  setMotor();

Serial.begin(115200);

}

void loop() {

  int jarak = sensor.ping_cm();

  Serial.println(jarak);

//logika

if (jarak >0 && jarak < 30) {

mundur ();delay (500);

rotasiKiri();delay(500);

}

  else{

    maju

  }

}

dan coding ini akan menghasilkan :

dan coding ini adalah pendefinisian dari sensor

#include <NewPing.h>

NewPing sensor(9,10,200); //trig,echo,jarak maka

void setup() {

Serial.begin(115200);

}

void loop() {

  int jarak = sensor.ping_cm();

  Serial.println(jarak);

}