BASIC4MCU | 질문게시판 | 아두이노 음주운정 방지 자동차
페이지 정보
작성자 기긱기 작성일2021-12-08 23:21 조회955회 댓글1건본문
RC카는 블루투스 모듈을 사용해서 제어를 하지만 이상하게 코드를 집어넣으면 RC카 움직이지 않습니다.
코드 확인후 지적 부탁드리겠습니다 ㅜㅜ
제가 하고자 하는것입니다.
1.RC카 전원을 키면 LCD에서"YOU CAN DRIVE"라는 문글과 함께 파란색 LED가 들어오면서 자동차 제어가 가능
2.알콜센서에 ex)150~300까지 정한후 그사이의 수치가 나오면LCD에서 "Alcohol detected"문글과 노란색LED와 부저 경고음이 나오면서 차량의 속도는 확줄어들면서 제어가 가능
3.알콜센서값이 300을 이상으로 올라갈시LED에서 "YOU DRUNK"문글과 빨간색LED와 큰 부저음 경고음이 나오면서 차량은 완전 멈춰 버리면서 제어가 불가능
4.알콜값이 떨어지면 위의 기능과 반대로 작용할것
부품은
https://www.devicemart.co.kr/goods/view?no=1358545
https://www.devicemart.co.kr/goods/view?no=12232871
사용했습니다.
또한 L298P쉴드에 부저가 달려있어 소리가 거기서 나옵니다.. 그것또한 안나오게 하고싶습니다.,,꼭좀 도와주세요 ㅜㅜ
#include <SoftwareSerial.h>
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27,16,2);
#include <DigitShield.h>
#define A_BAL 1 //모터A 속력 균형 계수 기본값 1
#define B_BAL 1 //모터B 속력 균형 계수 기본값 1
#define MOTOR_A_SPD 10 //모터A의 속력을 결정하는 핀
#define MOTOR_B_SPD 11 //모터B의 속력을 결정하는 핀
#define MOTOR_A_DIR 12 //모터A의 방향을 결정하는 핀
#define MOTOR_B_DIR 13 //모터B의 방향을 결정하는 핀
#define M_SPEED 150 //모터 속력
int mq3pin = A0; //MQ-3 센서핀을 아두이노 보드의 A0핀으로 설정
int buzzer = 9; //buzzer 디지털핀9번에 연결
int LedR= 1; //LED 디지털핀 1번에 연결
int LedG= 2; //LED 디지털핀 2번에 연결
int LedB= 3; //LED 디지털핀 3번에 연결
unsigned char m_a_spd = 0, m_b_spd = 0; //모터의 속력을 결정하는 전역변수
boolean m_a_dir = 0, m_b_dir = 0; //모터의 방향을 결정하는 전역변수
void setup()
{
Serial.begin(9600); //시리얼 통신 초기화
pinMode(LedR,OUTPUT); // LED 핀을 출력으로 설정
pinMode(LedG,OUTPUT); // LED 핀을 출력으로 설정
pinMode(LedB,OUTPUT); // LED 핀을 출력으로 설정
pinMode(MOTOR_A_DIR, OUTPUT); //모터A 방향 핀 출력으로 설정
pinMode(MOTOR_B_DIR, OUTPUT); //모터B 방향 핀 출력으로 설정
//Serial.println("Hello!"); //터미널 작동 확인용 문자열
lcd.init(); // LCD 초기화
lcd.backlight(); // 백라이트 켜기
lcd.setCursor(0,0);
lcd.print("Hello Driver");
lcd.setCursor(0,1);
Serial.println("운전 준비가 완료 되었습니다. 음주 측정기에 음주 측정해주세요");
}
void loop()
{
Serial.println(analogRead(mq3pin)); // MQ-3센서 출력값을 시리얼 모니터로 출력
int val = analogRead(mq3pin);
unsigned char bt_cmd = 0; //명령어 저장용 문자형 변수
if (Serial.available()) //데이터가 입력되었을 때
{
bt_cmd = Serial.read(); //변수에 입력된 데이터 저장
rc_ctrl_val(bt_cmd); //입력된 데이터에 따라 모터에 입력될 변수를 조정하는 함수
motor_drive(); //모터를 구동하는 함수
}
if(mq3pin>200)
{
//led파란색
Serial.println("----------------------");
Serial.println("정상입니다.");
Serial.print("알코올 값 :");
Serial.println(val);
Serial.println("운전이 준비 되었습니다. 숫자 1,2,3중 하나를 입력해주세요.");
analogWrite(LedR,LOW);
analogWrite(LedG,LOW);
analogWrite(LedB,HIGH);
delay(100);
m_a_spd = M_SPEED*1; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*1; //모터B의 M_SPEED의 PWM
motor_drive();
//LCD부분
lcd.init(); // LCD 초기화
lcd.setCursor(0,0); // 첫 번째 column열 , 첫 번째 row 행부터 시작
lcd.print("You can drive");
lcd.setCursor(0,1); // 첫 번째 column 열, 첫 번째 row 행부터 시작
lcd.print(val);
}
else if(mq3pin>=200 && mq3pin <300 )
{
//led노란색
//부저
tone(buzzer,2000,200);
Serial.println("----------------------");
Serial.println("면허 정지 위험 수준");
Serial.print("알코올 값 :");
Serial.println(val);
analogWrite(LedR,LOW);
analogWrite(LedG,HIGH);
analogWrite(LedB,LOW);
delay(100);
m_a_spd = M_SPEED*0.4; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*0.4; //모터B의 M_SPEED의 PWM
motor_drive();
//LCD부분
lcd.init(); // LCD 초기화
lcd.setCursor(0,0); // 첫 번째 column열 , 첫 번째 row 행부터 시작
lcd.print("Alcohol detected");
lcd.setCursor(0,1); // 첫 번째 column 열, 첫 번째 row 행부터 시작
lcd.print(val);
delay(1000);
}
else if(mq3pin<300)
{
//led빨간색
//부저
tone(buzzer, 4000, 1000);
Serial.println("--------------------------");
Serial.println("면허 취소, 구속 수준");
Serial.println("알코올 값 :");
Serial.println(val);
analogWrite(LedR,HIGH);
analogWrite(LedG,LOW);
analogWrite(LedB,LOW);
delay(100);
m_a_spd = M_SPEED*0; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*0; //모터B의 M_SPEED의 PWM
motor_drive();
//LCD부분
lcd.init();
lcd.setCursor(0,0);
lcd.print("You drunk");
lcd.setCursor(0,1);
lcd.print(val);
}
}
void rc_ctrl_val(unsigned char cmd) //입력된 데이터에 따라 모터에 입력될 변수를 조정하는 함수
{
if(cmd == 'w') //'w'가 입력되었을 때, 전진
{
m_a_dir = 1; //모터A 정방향
m_b_dir = 0; //모터B 정방향
m_a_spd = M_SPEED*A_BAL; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*B_BAL; //모터B의 M_SPEED의 PWM
}
else if(cmd == 'a') //'a'가 입력되었을 때, 제자리 좌회전
{
m_a_dir = 1; //모터A 정방향
m_b_dir = 1; //모터B 역방향
m_a_spd = M_SPEED*A_BAL; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*B_BAL; //모터B의 M_SPEED의 PWM
}
else if(cmd == 'd') //'d'가 입력되었을 때, 제자리 우회전
{
m_a_dir = 0; //모터A 역방향
m_b_dir = 0; //모터B 정방향
m_a_spd = M_SPEED*A_BAL; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*B_BAL; //모터B의 M_SPEED의 PWM
}
else if(cmd == 's') //'s'가 입력되었을 때, 후진
{
m_a_dir = 0; //모터A 역방향
m_b_dir = 1; //모터B 역방향
m_a_spd = M_SPEED*A_BAL; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*B_BAL; //모터B의 M_SPEED의 PWM
}
else if(cmd == 'x')
{
m_a_dir = 1; //모터A 정방향
m_b_dir = 0; //모터B 정방향
m_a_spd = M_SPEED*A_BAL; //모터A의 M_SPEED의 PWM
m_b_spd = M_SPEED*B_BAL; //모터B의 M_SPEED의 PWM
m_a_spd = 0; //모터A의 정지
m_b_spd = 0; //모터B의 정지
}
}
void motor_drive()
{
digitalWrite(MOTOR_A_DIR, m_a_dir); //모터A의 방향을 디지털 출력
digitalWrite(MOTOR_B_DIR, m_b_dir); //모터B의 방향을 디지털 출력
analogWrite(MOTOR_A_SPD, m_a_spd); //모터A의 속력을 PWM 출력
analogWrite(MOTOR_B_SPD, m_b_spd); //모터B의 속력을 PWM 출력
}
댓글 1
조회수 955master님의 댓글
master 작성일
제어가 복잡해지게되면
코드를 분석하는데에 많은 시간이 소요되기도 하고
모듈을 직접 구동하면서 디버깅을 해야 하므로
타인이 도와드리기 어려우니 스스로 해결하셔야합니다.