Pembuatan Program robot robogue pico V2 dengan sensor gerak
Langsung aja ke intinya , cekidottt !!!
- Langkah pertama tentunya siapkan robotnya beserta berbagai peralatan yang di butuhkan.
- Langkah kedua siapkan aplikasi arduino 1.5.5
- Langkah ketiga paste kan berbagai coding ini kedalam tab aplikasi arduino:
//pinMotor
//roda kiri
#define gasKiri 5
#define setirKiri 4
//roda kanan
#define gasKanan 6
#define setirKanan 7
- coding untuk mengatur kecepatan/perintah yang di berikan kepada robot :
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 untuk mengatur sensitivitas gerak pada robot :
#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 untuk pendefinisian sensor geraknya :
#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);
}
4. setelah itu tinggal di upload ke robot nya.
Tidak ada komentar:
Posting Komentar