Toggle navigation
Toggle navigation
This project
Loading...
Sign in
2021-1-capstone-design2
/
2014104077
Go to a project
Toggle navigation
Toggle navigation pinning
Projects
Groups
Snippets
Help
Project
Activity
Repository
Pipelines
Graphs
Issues
0
Merge Requests
0
Wiki
Snippets
Network
Create a new issue
Builds
Commits
Issue Boards
Authored by
Wonseok Kwak
2021-06-10 17:11:16 +0900
Browse Files
Options
Browse Files
Download
Email Patches
Plain Diff
Commit
f5f1f8df1ec4b80465aa9bca81668f75aca50483
f5f1f8df
1 parent
8cb27a37
CoDroneVibrateTest
Hide whitespace changes
Inline
Side-by-side
Showing
2 changed files
with
27 additions
and
30 deletions
source/DroneControl/CoDroneFlightTest/CoDroneFlightTest.ino
source/DroneControl/CoDroneVibrateTest/CoDroneVibrateTest.ino
source/DroneControl/CoDroneFlightTest/CoDroneFlightTest.ino
View file @
f5f1f8d
#include <CoDrone.h> // 코드론을 사용하기 위한 헤더파일
#define LeftVib 27
#define RightVib 28
void
setup
()
{
CoDrone
.
begin
(
115200
);
// 드론 플러그의 통신 개시 (115200bps)
CoDrone
.
AutoConnect
(
NearbyDrone
);
// 가장 가까운 위치의 드론과 연결
CoDrone
.
DroneModeChange
(
Flight
);
// 드론을 플라이트 모드로 설정합니다. (비행형)
pinMode
(
27
,
OUTPUT
);
pinMode
(
28
,
OUTPUT
);
}
void
loop
()
{
byte
bt1
=
digitalRead
(
11
);
// ■ □ □ □ □ □ □ 밑면 적외선 센서를 입력으로 사용
byte
bt4
=
digitalRead
(
14
);
// □ □ □ ■ □ □ □ 밑면 적외선 센서를 입력으로 사용
byte
bt8
=
digitalRead
(
18
);
// □ □ □ □ □ □ ■ 밑면 적외선 센서를 입력으로 사용
if
(
bt1
&&
!
bt4
&&
!
bt8
)
// 밑면 센서 가장 끝 11번 센서에 손을 대면 실행합니다.
{
CoDrone
.
FlightEvent
(
Stop
);
// 드론을 정지시킵니다.
}
if
(
!
bt1
&&
!
bt4
&&
bt8
)
// 밑면 센서 가장 끝 18번 센서에 손을 대면 실행합니다.
{
CoDrone
.
FlightEvent
(
Landing
);
// 드론을 착륙시킵니다.
}
if
(
PAIRING
==
true
)
// 연결(페어링)이 성공한 경우에만 실행
{
YAW
=
-
1
*
CoDrone
.
AnalogScaleChange
(
analogRead
(
A3
));
// 아날로그 3번 핀의 값을 YAW 값으로 사용합니다. - 좌우회전
THROTTLE
=
CoDrone
.
AnalogScaleChange
(
analogRead
(
A4
));
// 아날로그 4번 핀의 값을 THROTTLE 값으로 사용합니다. - 승하강
ROLL
=
-
1
*
CoDrone
.
AnalogScaleChange
(
analogRead
(
A5
));
// 아날로그 5번 핀의 값을 ROLL 값으로 사용합니다. - 좌우이동
PITCH
=
CoDrone
.
AnalogScaleChange
(
analogRead
(
A6
));
// 아날로그 6번 핀의 값을 PITCH 값으로 사용합니다. - 전후진
CoDrone
.
Control
(
SEND_INTERVAL
);
// 제어 신호를 보냅니다. 통신이 안정하게 가도록 시간을 두고 보냄 (최소 50ms)
}
digitalWrite
(
27
,
HIGH
);
digitalWrite
(
28
,
HIGH
);
}
...
...
source/DroneControl/CoDroneVibrateTest/CoDroneVibrateTest.ino
0 → 100644
View file @
f5f1f8d
#define LeftVib 27
#define RightVib 28
void
setup
()
{
pinMode
(
LeftVib
,
OUTPUT
);
pinMode
(
RightVib
,
OUTPUT
);
}
void
loop
()
{
digitalWrite
(
LeftVib
,
HIGH
);
digitalWrite
(
RightVib
,
HIGH
);
}
Please
register
or
login
to post a comment