งานที่16
16-1
#include <Stepper.h>
#include "Keypad.h"
#define STEP_ANGLE_4STEP 32 //360/11.25 degree
#define STEP_OUT_WITH_GEAR 2048 //32*64
Stepper stepper(STEP_ANGLE_4STEP,8,10,9,11);
char keys[4][4]={
{'7','8','9','A'},
{'4','5','6','B'},
{'1','2','3','C'},
{'*','0','#','D'}};
byte rowPins[] = {7,6,5,4};
byte colPins[] = {3,2,1,0};
int speedmotor = 400;
int dirmotor = 1;
Keypad keypad = Keypad(makeKeymap(keys),rowPins,colPins,4,4);
void setup()
{
}
void loop()
{
char key = keypad.getKey();
if (key != NO_KEY)
{
if (key == '1')
speedmotor = 400;
if (key == '2')
speedmotor = 700;
if (key == '3')
speedmotor = 1000;
if (key == 'A')
dirmotor = 1;
if (key == 'B')
dirmotor = -1;
if (key == 'C')
dirmotor = 0;
}
stepper.setSpeed(speedmotor);
stepper.step(dirmotor);
}
#include <Stepper.h>
#include "Keypad.h"
#define STEP_ANGLE_4STEP 32 //360/11.25 degree
#define STEP_OUT_WITH_GEAR 2048 //32*64
Stepper stepper(STEP_ANGLE_4STEP,8,10,9,11);
char keys[4][4]={
{'7','8','9','A'},
{'4','5','6','B'},
{'1','2','3','C'},
{'*','0','#','D'}};
byte rowPins[] = {7,6,5,4};
byte colPins[] = {3,2,1,0};
int speedmotor = 400;
int dirmotor = 1;
Keypad keypad = Keypad(makeKeymap(keys),rowPins,colPins,4,4);
void setup()
{
}
void loop()
{
char key = keypad.getKey();
if (key != NO_KEY)
{
if (key == '1')
speedmotor = 400;
if (key == '2')
speedmotor = 700;
if (key == '3')
speedmotor = 1000;
if (key == 'A')
dirmotor = 1;
if (key == 'B')
dirmotor = -1;
if (key == 'C')
dirmotor = 0;
}
stepper.setSpeed(speedmotor);
stepper.step(dirmotor);
}
16-2
#include <Servo.h>
Servo servo;
int x,y;
void setup()
servo.attach(9);
}
void loop()
{
x = analogRead(A0);
y = map(x,0,1023,0,179);
servo.write(y);
delay(50);
}
16-3
const int SW1 = 2;const int SW2 = 3;const int SW3 = 4; const int SW4 = 5;
const int ledPin = 13;const int Relay1 = 12;const int Relay2 = 11;
const int Relay3 = 10; const int Relay4 = 9;
int checkSW1 = 0;int checkSW2 = 0;int checkSW3 = 0;int checkSW4 = 0;
void setup() {
//========กำหนด output================
pinMode(ledPin, OUTPUT);
pinMode(Relay2, OUTPUT);
pinMode(Relay3, OUTPUT);
pinMode(Relay4, OUTPUT);
//========กำหนด input==================
pinMode(SW1, INPUT);
pinMode(SW2, INPUT);
pinMode(SW3, INPUT);
pinMode(SW4, INPUT);
//========กำหนดค่า output===================
digitalWrite(Relay1, LOW);
digitalWrite(Relay2, LOW);
digitalWrite(Relay3, LOW);
digitalWrite(Relay4, LOW);
}
void loop(){
//============ตรวจสอบการควบคุม SW================
checkSW1 = digitalRead(SW1);
checkSW2 = digitalRead(SW2);
checkSW3 = digitalRead(SW3);
checkSW4 = digitalRead(SW4);
//=============================================
if (checkSW1 == LOW) {
//UP();
digitalWrite(Relay1, HIGH);
}
if (checkSW2 == LOW) {
//DOWN();
digitalWrite(Relay2, HIGH);
}
if (checkSW3 == LOW) {
//RIGHT();
digitalWrite(Relay3, HIGH);
}
if (checkSW4 == LOW) {
//LEFT();
digitalWrite(Relay4, HIGH);
}
if (checkSW1 == HIGH && checkSW2 == HIGH && checkSW3 == HIGH && checkSW4 == HIGH) {
//STOP();
digitalWrite(Relay1, LOW);
digitalWrite(Relay2, LOW);
digitalWrite(Relay3, LOW);
digitalWrite(Relay4, LOW);
}
}
//=============function===================
void UP(){
// Serial.print('RRR');
digitalWrite(ledPin, HIGH);
digitalWrite(Relay1,LOW);
digitalWrite(Relay2,HIGH);
digitalWrite(Relay3,LOW);
digitalWrite(Relay4,HIGH);
}
void DOWN(){
// Serial.print('RRR');
digitalWrite(ledPin, HIGH);
digitalWrite(Relay1,HIGH);
digitalWrite(Relay2,LOW);
digitalWrite(Relay3,HIGH);
digitalWrite(Relay4,LOW);
}
void RIGHT(){
// Serial.print('RRR');
digitalWrite(ledPin, HIGH);
digitalWrite(Relay1,HIGH);
digitalWrite(Relay2,LOW);
digitalWrite(Relay3,LOW);
digitalWrite(Relay4,HIGH);
}
void LEFT(){
// Serial.print('RRR');
digitalWrite(ledPin, HIGH);
digitalWrite(Relay1,LOW);
digitalWrite(Relay2,HIGH);
digitalWrite(Relay3,HIGH);
digitalWrite(Relay4,LOW);
}
void STOP(){
// Serial.print('RRR');
digitalWrite(ledPin,LOW);
digitalWrite(Relay1,LOW);
digitalWrite(Relay2,LOW);
digitalWrite(Relay3,LOW);
digitalWrite(Relay4,LOW);
}
ความคิดเห็น
แสดงความคิดเห็น