Page 70 - 최강 아두이노 스마트 자동차 로봇 키트
P. 70

DC 모터 작동 테스트 기본 예제 코드


               우노  R3  보드에  센서  실드  V4  보드  적층  하여  테스트해봅니다.
               모터  회전  로직  체크하는  상태라  타이어는  잠시  분리해도  무방합니다.
               타이어가  바닥에  닿지  않게  하여  모터  회전하는  상태를  볼  수  있게  합니다.
               전진,  후진,  좌회전,  우회전을  아래와  같이  구현  하였습니다.



                        코드: 4WD_EX_1



                // 방향 전환 전역 변수
                #define FORWARD      1
                #define BACK               2

                #define LEFT                 3
                #define RIGHT              4
                #define STOP                  5

                char direction = STOP; //


                /*
                1: 정방향
                2: 좌회전
                3: 우회전
                4: 후진
                0: 정지
                */
                int speed = 200; //  최대 속도의  78 % for testing.


                //
                // 주의:    ENA, ENB  는  PWM 지원 포트에 연결한다.
                //
                #define ENA       6    // 모터  1 번 속도 제어 포트. PWM 포트.
                #define EN1      7   //  모터  1 번 방향 설정 포트.






                                                   69
   65   66   67   68   69   70   71   72   73   74   75