질문게시판 > 아두이노 블루투스와 초음파센서를 이용한 장애물 정지

TODAY147 TOTAL3,359,007
사이트 이용안내
Login▼/회원가입
최신글보기 질문게시판 기술자료 동영상강좌

아두이노 센서 ATMEGA128 PWM LED 초음파 AVR 블루투스 LCD UART 모터 적외선


BASIC4MCU | 질문게시판 | 아두이노 블루투스와 초음파센서를 이용한 장애물 정지

페이지 정보

작성자 둘둘이 작성일2023-09-22 16:20 조회2,070회 댓글2건

본문

	

블루투스 모듈을 이용해 리모콘으로 조종을 하다 앞에 물체가 있으면 멈추고 그뒤에 다시 리모컨을 이용해 움직이는 코딩을 하고 싶은데 어디가 잘못된건가요 ㅠ ㅠ

 

#include <SoftwareSerial.h>                            //가상 시리얼 통신을 위한 라이브러리 선언

#define BT_RXD 3                                       // 아두이노의 4번핀을 RX(받는 핀)로 설정
#define BT_TXD 4                                       // 아두이노 3번핀을 TX(보내는 핀)로 설정

SoftwareSerial bluetooth(BT_RXD,BT_TXD);               //블루투스 통신을 위한 설정

int RightMotor_E_pin = 5;                              // 오른쪽 모터의 Enable & PWM
int LeftMotor_E_pin = 6;                               // 왼쪽 모터의 Enable & PWM
int RightMotor_1_pin = 8;                              // 오른쪽 모터 제어선 IN1
int RightMotor_2_pin = 9;                              // 오른쪽 모터 제어선 IN2
int LeftMotor_3_pin = 10;                              // 왼쪽 모터 제어선 IN3
int LeftMotor_4_pin = 11;                              // 왼쪽 모터 제어선 IN4

int L_MotorSpeed = 185;                                // 왼쪽 모터 속도
int R_MotorSpeed = 160;                                // 오른쪽 모터 속도

int R_Motor = 0;
int L_Motor = 0;
int mode = 0;

void setup() {
  pinMode(RightMotor_E_pin, OUTPUT);                   // 출력모드로 설정
  pinMode(RightMotor_1_pin, OUTPUT);
  pinMode(RightMotor_2_pin, OUTPUT);
  pinMode(LeftMotor_3_pin, OUTPUT);
  pinMode(LeftMotor_4_pin, OUTPUT);
  pinMode(LeftMotor_E_pin, OUTPUT);

  Serial.begin(9600);
  bluetooth.begin(9600);
 
  Serial.println("Welcome Eduino!");
}

void loop() {
  if(bluetooth.available()){      
    char Blue_Val = bluetooth.read();
    Serial.print(Blue_Val);  
    control_SmartCar(Blue_Val);

if (Ultra_d < 150) {
      Serial.println("150 이하.");
      motor_role(LOW, LOW);      // 후진
      delay(1000);
      analogWrite(RightMotor_E_pin, 0);  
      analogWrite(LeftMotor_E_pin, 0);
      delay(200);

    if(mode == 0){
      motor_role(R_Motor, L_Motor);
    }
    else if(mode == 1){
      Right_role(R_Motor, L_Motor);
    }
    else if(mode == 2){
      Left_role(R_Motor, L_Motor);
    }
    else if(mode == 4){
      left_rotation(R_Motor, L_Motor);
    }
    else if(mode == 5){
      right_rotation(R_Motor, L_Motor);
    }
    else{
      analogWrite(RightMotor_E_pin, 0);
      analogWrite(LeftMotor_E_pin, 0);
    }  
  }
}

void control_SmartCar(char Blue_val){
  if( Blue_val == 'g' ){                             // "g" 버튼, 명령 : 전진
    R_Motor = HIGH; L_Motor = HIGH; mode = 0;
  }  
 
  else if( Blue_val == 'r' ){                        // "r" 버튼, 명령 : 우회전
    mode = 1;
  }
 
  else if( Blue_val == 'l' ){                        // "l" 버튼, 명령 : 좌회전
    mode = 2;
  }
 
  else if( Blue_val == 'b' ){                        // "b" 버튼, 명령 : 후진
    R_Motor = LOW; L_Motor = LOW; mode = 0;
  }

  else if( Blue_val == 's' ){                        // "s" 버튼, 명령 : 정지
    R_Motor = HIGH; L_Motor = HIGH; mode = 3;
  }
 
  else if( Blue_val == 'q' ){                        // "q" 버튼, 명령 : 제자리 좌회전
    mode = 4;
  }
 
  else if( Blue_val == 'w' ){                        // "w" 버튼, 명령 : 제자리 우회전
    mode = 5;
  }
 
  else{                                              // 지정하지 않은 주소입력.
  }
}

void motor_role(int R_motor, int L_motor){
   digitalWrite(RightMotor_1_pin, R_motor);
   digitalWrite(RightMotor_2_pin, !R_motor);
   digitalWrite(LeftMotor_3_pin, L_motor);
   digitalWrite(LeftMotor_4_pin, !L_motor);
   
   analogWrite(RightMotor_E_pin, R_MotorSpeed);                          // 우측 모터 속도값
   analogWrite(LeftMotor_E_pin, L_MotorSpeed);                           // 좌측 모터 속도값  
}

void Right_role(int R_motor, int L_motor){
   digitalWrite(RightMotor_1_pin, R_motor);
   digitalWrite(RightMotor_2_pin, !R_motor);
   digitalWrite(LeftMotor_3_pin, L_motor);
   digitalWrite(LeftMotor_4_pin, !L_motor);
   
   analogWrite(RightMotor_E_pin, max(R_MotorSpeed*0.4,90));             // 우측 모터 속도값
   analogWrite(LeftMotor_E_pin, 255);                                   // 좌측 모터 속도값
}

void Left_role(int R_motor, int L_motor){
   digitalWrite(RightMotor_1_pin, R_motor);
   digitalWrite(RightMotor_2_pin, !R_motor);
   digitalWrite(LeftMotor_3_pin, L_motor);
   digitalWrite(LeftMotor_4_pin, !L_motor);
   
   analogWrite(RightMotor_E_pin, 255);                                  // 우측 모터 속도값
   analogWrite(LeftMotor_E_pin, max(L_MotorSpeed*0.4,90));              // 좌측 모터 속도값  
}

void left_rotation(int R_motor, int L_motor){
   digitalWrite(RightMotor_1_pin, HIGH);
   digitalWrite(RightMotor_2_pin, LOW);
   digitalWrite(LeftMotor_3_pin, LOW);
   digitalWrite(LeftMotor_4_pin, HIGH);
   
   analogWrite(RightMotor_E_pin, R_MotorSpeed);                         // 우측 모터 속도값
   analogWrite(LeftMotor_E_pin, L_MotorSpeed);                          // 좌측 모터 속도값
}

void right_rotation(int R_motor, int L_motor){
   digitalWrite(RightMotor_1_pin, LOW);
   digitalWrite(RightMotor_2_pin, HIGH);
   digitalWrite(LeftMotor_3_pin, HIGH);
   digitalWrite(LeftMotor_4_pin, LOW);
   
   analogWrite(RightMotor_E_pin, R_MotorSpeed);                         // 우측 모터 속도값
   analogWrite(LeftMotor_E_pin, L_MotorSpeed);                          // 좌측 모터 속도값
}
  • BASIC4MCU 작성글 SNS에 공유하기
  • 페이스북으로 보내기
  • 트위터로 보내기
  • 구글플러스로 보내기

댓글 2

조회수 2,070

master님의 댓글

master 작성일

if(Ultra_d<150){
      Serial.println("150 이하.");
      motor_role(0,0); delay(1000); // 후진
      analogWrite(RightMotor_E_pin,0); analogWrite(LeftMotor_E_pin,0); delay(200);
      return; // <-- 추가
    } // <-- 추가

둘둘이님의 댓글

둘둘이 댓글의 댓글 작성일

댓글 감사합니다! 혹시 추가해서 해봤는데도 장애물을 보고 멈추지 않는데 다른부분 틀린곳이 있을까요? ㅠ ㅠ

질문게시판HOME > 질문게시판 목록

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다. 스태프 19-01-15 23755
공지 사이트 이용 안내댓글[31] master 17-10-29 37716
질문 ATmega4809 nRF24L01 모듈을 이용한 무선 통신댓글[3] Ahri 24-06-12 16
질문 atmega128에 dht11 왜 측정을 못하죠?댓글[1] 탈북한시민 24-06-11 32
질문 atmega128이 실행이 되지 않습니다댓글[1] 이미지첨부파일 니굴 24-06-10 36
질문 아트메가 128 쓰는디 while 문이 안먹혀요댓글[1] 수히 24-06-09 27
질문 atmega128 UART통신으로 FND출력 Rion 24-06-09 44
답변 답변글 답변 : atmega128 UART통신으로 FND출력댓글[1] master 24-06-10 29
질문 atmega128 라인트레이서 코드와 회로도 질문...몇일 째 머리아파 죽겠네요ㅠ댓글[2] 이미지첨부파일 왕두일 24-06-06 136
답변 답변글 답변 : atmega128 라인트레이서 코드와 회로도 질문...몇일 째 머리아파 죽겠네요ㅠ master 24-06-07 67
질문 atmega128을 이용한 LCD 사용에 문제가 발생했습니다.댓글[3] 이미지 네넴 24-06-05 371
질문 Co 센서 값에 따른 ppm을 계산하려는데댓글[1] 라칸 24-06-05 75
질문 17HS4401, A4988 스텝모터 제어댓글[1] 이미지 jhbaik 24-06-03 96
질문 코드비전avr을 이용한 아두이노 우노 제어댓글[1] gkstntjd 24-05-29 122
질문 Energia 시리얼 모니터에 아무것도 출력되지않습니다.댓글[1] 김의공 24-05-22 138
질문 아두이노 스위치, 에어펌프 연결댓글[1] 이미지첨부파일 존존 24-05-20 290
질문 MSP430런치패드를 이용한 LCD 코딩 관련 질문댓글[1] 뀨쥰이 24-05-16 182
질문 생활 속 가스 센서 이미지첨부파일 Fosen 24-05-13 97
질문 atmega128A로 초음파센서 바밤 24-05-13 235
답변 답변글 답변 : atmega128A로 초음파센서 master 24-05-13 204
질문 eeprom 값 출력이 다르게 나옵니다댓글[5] 이미지첨부파일 idghte 24-05-05 357
답변 답변글 답변 : eeprom 값 출력이 다르게 나옵니다 master 24-05-05 112
질문 센서나 블루투스에서 조건문이 실행이 느립니다. 현아 24-05-03 172
답변 답변글 답변 : 센서나 블루투스에서 조건문이 실행이 느립니다. master 24-05-03 155
질문 님들 MG811 이산화탄소 센서를 쓰는데 라칸 24-05-03 142
답변 답변글 답변 : 님들 MG811 이산화탄소 센서를 쓰는데 이미지 master 24-05-03 134
질문 아두이노와 디지털 홀센서 사용 중 sampling rate 문제입니다. 첨부파일 fjur564 24-05-03 163
답변 답변글 답변 : 아두이노와 디지털 홀센서 사용 중 sampling rate 문제입니다. 이미지 master 24-05-03 192
질문 OP AMP댓글[1] 이미지첨부파일 창원거북이 24-05-02 144
질문 라즈베리파이 라우팅 테이블을 영구 추가하려는데 라칸 24-04-30 124
게시물 검색

2022년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2021년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2020년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2019년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2018년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
Privacy Policy
MCU BASIC ⓒ 2020
모바일버전으로보기