hongwai.c

来自「基于凌阳61板的五层电梯模型C语言程序」· C语言 代码 · 共 42 行

#include <spce061a.h>
int hw_flag[2];
extern int hongw_flag;
extern void delay(int);
void hongwai(void)
{
	*P_IOB_Dir&=0xfdff;                    //B9为上拉电阻输入
	*P_IOB_Attrib&=0xfdff;
	*P_IOB_Data|=0x0200;
	
	if(*P_IOB_Data&0x0200)              //遇黑线  标志hw_flag[1]置1
	{
		delay(1);
		if(*P_IOB_Data&0x0200)
		{
			delay(1);
		    if(*P_IOB_Data&0x0200)
		         hw_flag[1]=1;
		}
	}
	else if((*P_IOB_Data&0x0200)==0)
	{
		 delay(1);		 
		 if((*P_IOB_Data&0x0200)==0)
		 {
		 	delay(1);		 
		    if((*P_IOB_Data&0x0200)==0)
		     hw_flag[1]=0;
		 }
	}
	if(hw_flag[1]==0)                           //标志为零,即遇白线,标志hw_flag[0]置零
	{
		hw_flag[0]=0;
	}
	if(hw_flag[0]==0&&hw_flag[1])
	{
		hongw_flag=1;
	}
	else hongw_flag=0;
	hw_flag[0]=hw_flag[1];
	*P_Watchdog_Clear=0x0001;
}