Rabu, 05 Maret 2014

Pembuatan Program robot robogue pico V2 dengan sensor gerak

Pembuatan Program robot robogue pico V2 dengan sensor gerak

            Langsung aja ke intinya , cekidottt !!!

  1.  Langkah pertama tentunya siapkan robotnya beserta berbagai peralatan yang di butuhkan.
  2.  Langkah kedua siapkan aplikasi arduino 1.5.5
  3.  Langkah ketiga paste kan berbagai coding ini kedalam tab aplikasi arduino:
-  coding untuk memanggil perintah dalam robot :
 //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