#include "c:\winavr\ezrobomaster\ezrmlib.h"
#include "sef0.5.h"
#define LIGHT_LIMIT 50 //센서 평균값

int main(void)
{
 unsigned char sensor1;
 unsigned char lcd_buffer[8];
 
 //Ez-RoboMaster 초기화
 SysInit();
 //초음파 센서 초기화
 SnInit();
 
   //LCD 출력
   //             "01234567"
 LcdDspStr(0,1, "STEPTest"); 
 LcdClr (LINE_ALL);
 //스텝모터 초기화
 StmInit();
 //스텝모터의 최고 값 설정
 StmSetSpd(STEP_LEFT+STEP_RIGHT, 500);
 while(1)
 {
  //DIO_D0의 값을 LCD에 표시
  sprintf(lcd_buffer, "DIO_0=%d ", sensor1);
  LcdDspStr(0,1,lcd_buffer);
 }
  //검은색 라인이 감지되면
  if(sensor1==FALSE)
  {
   //스텝모터 무한 회전
   StmRun(STEP_LEFT, 0, STOP_SLOW); 
   StmRun(STEP_RIGHT, 0, STOP_SLOW);
  }
   else
  {
   //스텝모터 정지
   StmStopSlow(STEP_LEFT+STEP_RIGHT);
  }
  
 }
여기다가 초음파 센서 달아서
17cm 이내로 감지해서 3초 전진후 물건을 들어올려서 라인끝에서 물건내려놓고 정지 하는 프로그램 만들고싶은데
여기다가 초음파센서 명령어 몇개만 갈쳐주세요 횽들아