메카트로닉스 진로 교육 (중2)
제공 코드5차시, 버튼과 가변저항 입력값 출력
| 언어 | Arduino C++ |
|---|---|
| 설명 | '시리얼 모니터로 확인하기' 단계 코드 |
const int BTN = 7; // tact switch to GND
const int POT = A0; // potentiometer middle pin
void setup() {
pinMode(BTN, INPUT_PULLUP); // pressed = 0, released = 1
Serial.begin(9600);
}
void loop() {
int b = digitalRead(BTN);
int v = analogRead(POT); // 0..1023
Serial.print("button=");
Serial.print(b);
Serial.print(" pot=");
Serial.println(v);
delay(200);
}메카트로닉스 진로 교육 (중2)
제공 코드6차시, 가변저항으로 서보 각도 조절
| 언어 | Arduino C++ |
|---|---|
| 설명 | 로봇팔 키트 코드 Potentiometer_control.ino(키트 제조사 예제, 관절 5개)를 관절 1개로 줄임 |
#include <Servo.h>
Servo servo1;
void setup() {
servo1.attach(9);
Serial.begin(9600);
}
void loop() {
int v = analogRead(A0); // 0..1023
int angle = map(v, 0, 1023, 0, 180); // to servo angle
servo1.write(angle);
Serial.println(angle);
delay(50);
}메카트로닉스 진로 교육 (중2)
제공 코드9차시, 버튼으로 그리퍼 열고 닫기 (각도 제한)
| 언어 | Arduino C++ |
|---|---|
| 설명 | 신규 작성. OPEN/CLOSE 값은 8~9차시에 팀이 실측한 각도로 바꾼다 |
#include <Servo.h>
const int BTN = 7;
const int OPEN_DEG = 30; // measured
const int CLOSE_DEG = 95; // measured; beyond this the jaws collide
Servo grip;
bool closed = false;
void setup() {
pinMode(BTN, INPUT_PULLUP);
grip.attach(9);
grip.write(OPEN_DEG);
Serial.begin(9600);
}
void loop() {
if (digitalRead(BTN) == LOW) {
closed = !closed;
int target = closed ? CLOSE_DEG : OPEN_DEG;
target = constrain(target, OPEN_DEG, CLOSE_DEG);
grip.write(target);
Serial.println(closed ? "CLOSE" : "OPEN");
while (digitalRead(BTN) == LOW) {} // wait for release
delay(50); // debounce
}
}