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

pinMode(LT_MODULE_F, INPUT);
pinMode(LT_MODULE_R, INPUT);
}

// is detected left
bool lt_isLeft()
{
int ret = digitalRead(LT_MODULE_L);
return ret == 1 ? true : false;

}

bool lt_isForward()
{
int ret = digitalRead(LT_MODULE_F);
return ret == 1 ? true : false;

}

bool lt_isRight()
{
int ret = digitalRead(LT_MODULE_R);
return ret == 1 ? true : false;
}

//
void lt_mode_update()
{
int ll = lt_isLeft();
int ff = lt_isForward();
int rr = lt_isRight();

if (ll&&ff&&rr)
{
g_carDirection = CAR_DIR_ST; // stop
}
else
if (!ll&&!ff&&!rr)
{
g_carDirection = CAR_DIR_ST; // stop

215