[NXC] 레고로봇 라인트레이서 소스코드

소개

레고로봇 라인트레이서 소스코드(.NXC)입니다.

창의적공학설계에서 우수상 받은 코드입니다.

컴파일 실행환경

1. 프로젝트 시나리오2. 로봇 설계도3. 프로그램 알고리즘 소스코드

본문내용

3. 프로그램 알고리즘 소스코드

#define light SENSOR_1
#define touch SENSOR_2
#define sound SENSOR_3
#define sonic SENSOR_4

#define Right OUT_A
#define Left OUT_C
#define Both OUT_AC
#define Tail OUT_B

#define TIME1 40 //for문 반복횟수 결정
#define TIME2 10 //for문 안에서 딜레이 결정

#define power1 1 //바퀴출력의 배수, 현재 1배수
#define power2 70 //바퀴출력의 최대값

#define Go(x) OnFwd(Both, x)
#define GoR(x) OnFwd(Right, x)
#define GoL(x) OnFwd(Left, x)

#define Back(x) OnRev(Both, x)
#define BackR(x) OnRev(Right, x)
#define BackL(x) OnRev(Left, x)

#define relax1 Off(Both); Wait(350)
#define relax2 Off(Both); Wait(500)

#define toneH PlayTone(1000,100)
#define toneL PlayTone(100,100)


int light4 = 63; //이탈하고 남음....언덕
int light3 = 52; //선을 이탈.
int light2 = 45; //2과 3사이는 선에 걸침.
int light1 = 36; //이거보다 작으면 선에 있음.

int lightMax = 65;
int lightCenter = 40;
int lightMin = 18;

int vPlus = 10; //바퀴출력 추가, 현재 +10

......

참고자료

· 없음