//cny_car   探測白底黑線，沿著黑線運動
#include <io8515v.h>
#include <macros.h>
#include <sl3010.c>

unsigned char cny_in;

#define cny_delayms 50

void cny_car()
{
 unsigned char cny_times;
 port_init();
start_up: 
 mic_startup();
 
 while(1)
      {
//	   sw_touch();
	   
	   cny_in = PINC & 0xe0;
	   if(cny_in == 0x00 || cny_in == 0x40 || cny_in == 0xa0)
	     {//前行
	      forward();   //前行
		  cny_times = 0x00;
		 }
	   if(cny_in == 0x20 || cny_in == 0x60)
	     {//慢速右轉
		  turn_right_s();   //慢速右轉
		  delay_ms(cny_delayms);
		  cny_times = 0x00;
		 }
	   if(cny_in == 0x80 || cny_in == 0xc0)
	     {//慢速左轉
          turn_left_s();    //慢速左轉
          delay_ms(cny_delayms);
		  cny_times = 0x00;
 		 }
	   if(cny_in == 0xe0)
	     {//前行--探測多次都為 0xe0 ,停止運行
		  forward();
		  cny_times++;
		  delay_ms(10);
		  if(cny_times == 0x64)
			{
			 stop();   //停止運動//熄滅指示燈   
             goto start_up;
			}
		 }
	  }
}

void main()
{
 cny_car();
}