Anda di halaman 1dari 12

MOTOR SERVO SWEP 0 - 90 d DOUBLE SERVO

#include <Servo.h> #include <Servo.h>


Servo myservo;
int pos = 0; Servo servo1;
void setup() { // Define left servo
myservo.attach(9); Servo servo2;
} // Define right
void loop() { servo
for (pos = 0; pos <= 180; pos += 1) {
// in steps of 1 degree void setup() {
myservo.write(pos); servo1.attach(10);
delay(5); // Set left servo to
digital pin 10
} servo2.attach(9);
for (pos = 180; pos >= 0; pos -= 1) { // Set right servo
myservo.write(pos); to digital pin 9
delay(5); }
} void loop() {
} // Loop through
motion tests
forward();
// Example: move
forward
delay(2000);
// Wait 2000
milliseconds (2
seconds)
reverse();
delay(2000);
turnRight();
delay(2000);
turnLeft();
delay(2000);
stopRobot();
delay(2000);
}

// Motion routines
for forward,
reverse, turns, and
stop
void forward() {
servo1.write(0);

servo2.write(180);
}
void reverse() {

servo1.write(180);
servo2.write(0);
}
void turnRight() {

servo1.write(180);

servo2.write(180);
}
void turnLeft() {
servo1.write(0);
servo2.write(0);
}
void stopRobot() {
servo1.write(90);
servo2.write(90);
}

Motor Servo 4 SEVEN SEGMENT


void setup() {
#include <Servo.h> pinMode(2,
OUTPUT);
Servo servo1; pinMode(3,
Servo servo2; OUTPUT);
Servo servo3; pinMode(4,
Servo servo4; OUTPUT);
pinMode(5,
void setup() { OUTPUT);
servo1.attach(9); pinMode(6,
servo2.attach(10); OUTPUT);
servo3.attach(8); pinMode(7,
servo4.attach(7); OUTPUT);
} pinMode(8,
OUTPUT);
void loop() { digitalWrite(9, 0);
// start with the
"dot" off
servo1.write(180); }
delay(1000);
servo1.write(0); void loop() {
delay(10); // write '0'
servo2.write(180); digitalWrite(2, 1);
delay(1000); digitalWrite(3, 1);
servo2.write(0); digitalWrite(4, 1);
delay(10); digitalWrite(5, 1);
servo3.write(180); digitalWrite(6, 1);
delay(1000); digitalWrite(7, 1);
servo3.write(0); digitalWrite(8, 0);
delay(10); delay(500);
servo4.write(180); // write '1'
delay(1000); digitalWrite(2, 0);
servo4.write(0); digitalWrite(3, 1);
delay(10); digitalWrite(4, 1);
digitalWrite(5, 0);
} digitalWrite(6, 0);
digitalWrite(7, 0);
digitalWrite(8, 0);
delay(500);
// write '2'
digitalWrite(2, 1);
digitalWrite(3, 1);
digitalWrite(4, 0);
digitalWrite(5, 1);
digitalWrite(6, 1);
digitalWrite(7, 0);
digitalWrite(8, 1);
delay(500);
// write '3'
digitalWrite(2, 1);
digitalWrite(3, 1);
digitalWrite(4, 1);
digitalWrite(5, 1);
digitalWrite(6, 0);
digitalWrite(7, 0);
digitalWrite(8, 1);
delay(500);
// write '4'
digitalWrite(2, 0);
digitalWrite(3, 1);
digitalWrite(4, 1);
digitalWrite(5, 0);
digitalWrite(6, 0);
digitalWrite(7, 1);
digitalWrite(8, 1);
delay(500);
// write '5'
digitalWrite(2, 1);
digitalWrite(3, 0);
digitalWrite(4, 1);
digitalWrite(5, 1);
digitalWrite(6, 0);
digitalWrite(7, 1);
digitalWrite(8, 1);
delay(500);
// write '6'
digitalWrite(2, 1);
digitalWrite(3, 0);
digitalWrite(4, 1);
digitalWrite(5, 1);
digitalWrite(6, 1);
digitalWrite(7, 1);
digitalWrite(8, 1);
delay(500);
// write '7'
digitalWrite(2, 1);
digitalWrite(3, 1);
digitalWrite(4, 1);
digitalWrite(5, 0);
digitalWrite(6, 0);
digitalWrite(7, 0);
digitalWrite(8, 0);
delay(500);
// write '8'
digitalWrite(2, 1);
digitalWrite(3, 1);
digitalWrite(4, 1);
digitalWrite(5, 1);
digitalWrite(6, 1);
digitalWrite(7, 1);
digitalWrite(8, 1);
delay(500);
// write '9'
digitalWrite(2, 1);
digitalWrite(3, 1);
digitalWrite(4, 1);
digitalWrite(5, 0);
digitalWrite(6, 0);
digitalWrite(7, 1);
digitalWrite(8, 1);
delay(2000);

}
LDR ARDUINO

int ldr=A1;
int val=0;
void setup()

{
// put your setup code here, to run once:
Serial.begin(9600);
}

void loop() {
// put your main code here, to run repeatedly:
val=analogRead(ldr);
Serial.println("ldr intensity =");
Serial.println("WELCOME TO LDR");
Serial.println(val);
delay(100);
}
//**********************************************************
// Capteur de distance ultrasons HC-SR04 avec Arduino Uno
// TipTopBoards.com 06 01 2014 Rolland
// Cabler +5V et GND du dtecteur sur l'arduino
//
// Trig -> pin 13
// Echo -> pin 12
// Led verte + 470R -> pin 10
// Led rouge + 470R -> pin 11
// Les leds s'allument selon la distance trop prs / trop loin
//**********************************************************
#define trigPin 13 //Trig Ultrasons (sortie)
#define echoPin 12 //Echo Ultrasons (entre)
#define ledVerte 11 //Led verte
#define ledRouge 10

void setup() {
Serial.begin (9600);
pinMode(trigPin, OUTPUT); //Trig est une sortie
pinMode(echoPin, INPUT); //Echo est le retour, en entre
pinMode(ledVerte, OUTPUT);
pinMode(ledRouge, OUTPUT);
}

void loop() {
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10); //Trig dclench 10ms sur HIGH
digitalWrite(trigPin, LOW);

// Calcul de l'cho
duration = pulseIn(echoPin, HIGH);
// Distance proportionnelle la dure de sortie
distance = duration*340/(2*10000); //Vitesse du son thorique

if (distance < 20) { // Distance trop prs


digitalWrite(ledVerte,HIGH); //Vert clair seulement
digitalWrite(ledRouge,LOW);

}
else { //Trop loin
digitalWrite(ledVerte,LOW);
digitalWrite(ledRouge,HIGH);

}
//Hors de porte (duration)
if ( distance <= 0){
//Serial.print(duration);
Serial.println("Hors de portee");
}
else {
Serial.println(distance);
Serial.println(" cm ");

}
delay(100); //0.1 sec entre deux mesures
}
LCD TUTORIAL

#include <LiquidCrystal.h>
// initialize the library with the numbers of the interface pins
LiquidCrystal lcd(12, 11, 5, 4, 3, 2);
int store=0;
void setup()
{
// set up the LCD's number of columns and rows:
lcd.begin(16, 2);
// initialize the serial communications:
Serial.begin(9600);
}
void loop()
{
// when characters arrive over the serial port...
if (Serial.available())
{
// save the data
store=Serial.read();
// display each character to the LCD
lcd.write(store);

}
}

#include <IRremote.h>

int IRpin = 11;


int ledpin6 = 6; //pin LED is connected to
int ledpin5 = 5;
int ledpin4 = 4;
int ledpin3 = 3;

IRrecv irrecv(IRpin);
decode_results results;

void setup()
{
Serial.begin(9600); //open the serial port
irrecv.enableIRIn(); // start receiving data
pinMode(ledpin6, OUTPUT); //define LED as output
pinMode(ledpin5, OUTPUT);
pinMode(ledpin4, OUTPUT);
pinMode(ledpin3, OUTPUT);
}

void loop()
{
if (irrecv.decode(&results)) {
Serial.println(results.value, DEC); //print the value

if(results.value==4294967295) // your value here


{
digitalWrite(ledpin6, HIGH); // turn the LED on
delay(100);

if(results.value==16718055) // your value here


{
digitalWrite(ledpin5, HIGH); // turn the LED on
delay(100); // wait for a second
}
if(results.value==16743045) // your value here
{
digitalWrite(ledpin4, HIGH); // turn the LED on
delay(100); // wait for a second
}

if(results.value==16716015) // your value here


{
digitalWrite(ledpin3, HIGH); // turn the LED on
delay(100); // wait for a second
}

irrecv.resume(); // receive the next value


}
}
const int trigPin = 7;
const int echoPin = 8;

/* Initialize serial comms to a baud rate of 9600 */

void setup(){
Serial.begin(9600);
}

void loop(){
SENSOR ULTRASONIC

/* Define variables for ping duration and distance in inches and cm */

long duration, inches, cm;

/* The sensor is triggered by a HIGH pulse of at least 10us


Giving a short LOW pulse initially ensures a sharp HIGH pulse */

pinMode(trigPin, OUTPUT);
digitalWrite(trigPin, LOW);
delayMicroseconds(50);
digitalWrite(trigPin, HIGH);
delayMicroseconds(100);
digitalWrite(trigPin, LOW);

// Set the echo pin as an input


pinMode(echoPin, INPUT);

/* Read the signal from the sensor. A HIGH pulse whose


duration is the time (in microseconds) from the sending
of the ping to the reception of its echo from an object */

duration = pulseIn(echoPin, HIGH);

// Convert time into distance

inches = microsecondsToInches(duration);
cm = microsecondsToCentimeters(duration);

Serial.print(inches);
Serial.print("in, ");
Serial.print(cm);
Serial.print("cm");
Serial.println();

delay(1000);
}

/* There are 73.746 microseconds per inch, sound travels


at 1130 feet per second. The distance travelled by the ping,
outbound and return, is divided by 2 to get the distance of the obstacle. */
long microsecondsToInches(long microseconds)
{
return microseconds/74/2;
}

/* The speed of sound is 340 m/s or 29 microseconds per centimetre.


The ping travels out and back, so to find the distance of the
object we take half of the distance travelled. */
long microsecondsToCentimeters(long microseconds)
{
return microseconds/29/2;
}
SENSOR ULTRASONIC + LCD

#include <LiquidCrystal.h>
#define trigPin 10
#define echoPin 13

LiquidCrystal lcd(12, 11, 5, 4, 3, 2);

void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}

void loop() {
float duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);

digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);


distance = (duration / 2) * 0.0344;

if (distance >= 400 || distance <= 2){


lcd.print("Out of range");
delay(500);
}
else {
lcd.print(distance);

lcd.print(" cm");

delay(1000);
}
delay(1000);
lcd.clear();
}
SENSOR KELEMBABAN VS ULTRASONIC DAN LCD

#include <dht.h>
#include <LiquidCrystal.h>

#define trigPin 10
#define echoPin 13
#define DHT11_PIN 7

LiquidCrystal lcd(12, 11, 5, 4, 3, 2);

dht DHT;

void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}

void loop() {

float duration, distance;


float speed;

digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);


speed = 331.4 + (0.606 * DHT.temperature) + (0.0124 * DHT.humidity);
distance = (duration / 2) * (speed / 10000);

if (distance >= 400 || distance <= 2){


lcd.print("Out of range");
delay(500);
}
else {
lcd.print(distance);
lcd.print(" cm");
delay(500);
}
delay(500);
lcd.clear();
}

#include <math.h>
#define trigPin 10
#define echoPin 13

double Thermistor(int RawADC) {


double Temp;
Temp = log(10000.0*((1024.0/RawADC-1)));
Temp = 1 / (0.001129148 + (0.000234125 + (0.0000000876741 * Temp * Temp ))* Temp );
Temp = Temp - 273.15;
return Temp;
}
SENSOR JARAK AKURASI TINGGI

//R1 = 100K Ohm resistor Th = 100K Ohm thermistorNote: the value of R1 should equal the
resistance of your thermistor.After everything is connected, upload this code to the Arduino:

void setup() {
Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}

void loop() {
int val;
double temp;
val=analogRead(0);
temp=Thermistor(val);

float duration, distance;


float spdSnd;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);

digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);


spdSnd = 331.4 + (0.606 * temp) + 0.62;
distance = (duration / 2) * (spdSnd / 10000);

if (distance >= 400 || distance <= 2){


Serial.print("Distance = ");
Serial.println("Out of range");
}
else {
Serial.print("Distance = ");
Serial.print(distance);
Serial.println(" cm");
delay(500);
}
delay(500);
}

SENSOR KELEMBABAN DAN ULTRASONIC

#include <dht.h>
#define trigPin 10
#define echoPin 13
#define DHT11_PIN 7

dht DHT;

void setup() {
Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}

void loop() {

float duration, distance;


float speed;

digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);


speed = 331.4 + (0.606 * DHT.temperature) + (0.0124 * DHT.humidity);
distance = (duration / 2) * (speed / 10000);

if (distance >= 400 || distance <= 2){


Serial.print("Distance = ");
Serial.println("Out of range");
}
else {
Serial.print("Distance = ");
Serial.print(distance);
Serial.println(" cm");
delay(1000);
}
delay(1000);
}

Anda mungkin juga menyukai