p_pelcod_倒装.c

这是监视器行业常见的键盘与球机通讯协议的C语言源代码

#include <REG54.H>
#include <INTRINS.H>
#include "protocol.h"
#include "kernel.h"
#include "config.h"

unsigned char data data1,data2,data3,data5,data6,datax;
unsigned char bdata data4;
sbit ext_fg = data4^0;
bit power_fg = 1;  

void (code *rr)(unsigned char rc);
void word1(unsigned char rc);
void word2(unsigned char rc);
void word3(unsigned char rc);
void word4(unsigned char rc);
void word5(unsigned char rc);
void word6(unsigned char rc);
void word7(unsigned char rc);

void word1(unsigned char rc) using 1
{
	if (rc == 0xff) rr = word2;
}

void word2(unsigned char rc) using 1
{
	if (rc != id) 
		rr = word1;
	else
	{
		rr = word3;
		datax = rc;
	}
}

void word3(unsigned char rc) using 1
{
	data3 = rc;
	datax += data3;
	rr = word4;
}

void word4(unsigned char rc) using 1
{
	data4 = rc;
	datax += data4;
	rr = word5;
}

void word5(unsigned char rc) using 1
{
	data5 = rc;
	datax += data5;
	rr = word6;
}

void word6(unsigned char rc) using 1
{
	data6 = rc;
	datax += data6;
	rr = word7;
}

void word7(unsigned char rc) using 1
{
	rr = word1;
	if (rc == datax)
	{
		if(ext_fg)
		{	
			run_swing_fg = 0;
			run_swing2_fg = 0;
			run_seq2_fg = 0;
			if(data4 == 0x03)
			{   
					set_pre_fg = 1;
					seq[15] = data6;
			}
			else if(data4==0x07)
			{
				
					call_pre_fg = 1;
					seq[15] = data6;
			}
		}
		else
		{
			if(data3)
			{
				switch(data3)
				{
					case 0x01:	//foucs near
						focu_near_fg = 1;
						focus_need_stop = 1;
						break;
					case 0x02:	//iris open
						iris_open_fg = 1;
						break;
					case 0x04:	//iris close
						iris_close_fg = 1;
						break;
					case 0x10:	//auto-scan and turn camera on
						run_swing2_fg = 0;
						break;
					case 0x98:
						run_swing2_fg = 1;
                        break;
					case 0x90:
						run_swing2_fg = 1;
						break;
					case 0x88:
						power_on_fg = 1;
						break;
					case 0x08:
						power_off_fg = 1;
						break;								
				}
			}
			else
			{
				switch(data4)
				{
					case 2:	//pan turn right
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 4; 
						seq[13] = data5;
						seq[14] = 0;
						break;
					case 4:	//pan turn left
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 2; 
						seq[13] = data5;
						seq[14] = 0;
						break;
					case 16:	//titl down
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 8; 
						seq[13] = 0;
						seq[14] = data6;
						break;
					case 8:	//titl up 
   						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 16; 
						seq[13] = 0;
						seq[14] = data6;
						break;	
					case 12:	//pan turn left and titl up	
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 18;//12; 
						seq[13] = data5;
						seq[14] = data6;
						break;		
					case 18:	//pan turn right and titl down	
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 12;//0x0a; 
						seq[13] = data5;
						seq[14] = data6;
						break;	
					case 10:	//pan turn right and titl up
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 20;//14; 
						seq[13] = data5;
						seq[14] = data6;
						break;
					case 20:	//pan turn left and titl down
						cont_fg = 1;
						run_swing_fg = 0;
						run_swing2_fg = 0;
						run_seq2_fg = 0;
						seq[12] = 10;//0x0c; 
						seq[13] = data5;
						seq[14] = data6;
						break;
					case 0x20:	//zoom tele
						zoom_tele_fg = 1;
						zoom_need_stop = 1;
						break;
					case 0x40:	//zoom wide
						zoom_wide_fg = 1;
						zoom_need_stop = 1;
						break;
					case 0x80:	//focus far
						focu_far_fg = 1;
						focus_need_stop = 1;
						break;
					default:		
						if (_testbit_(zoom_need_stop)) zoom_stop_fg = 1;
						if (_testbit_(focus_need_stop)) focu_stop_fg = 1;
						seq[12] = 0;				
						cont_fg = 1;		
						break;	
				}
			}		
		}
	}
}


extern bit do_set_addon(unsigned char no)
{  
//#ifndef DIS660
	switch (no)
	{
	case F_SCAN_START:   		
	case F_SCAN_END:   
		no = no;
		return 0;
	case F_SEQ_SET:
		run_seq_fg = 0;
		run_seq2_fg = 0;
		return 1;
#ifndef DIS660
	case F_CAM_RESET:			//camera reset
		addon_fg = 1;
		seq[10] = A_RESET;
		seq[11] = ON;
		return 1;
	case F_BLC_OFF:			
		addon_fg = 1;   
		seq[10] = A_BLC;
		seq[11] = OFF;
		return 1;
	case F_ZERO_OFF:			
		addon_fg = 1;
		seq[10] = A_ZERO;
		seq[11] = OFF;
		return 1;
	case F_MENU_OFF:			
		disp_off_fg = 1;
		return 1;
	case F_DIGI_OFF:
		addon_fg = 1;		
	 	seq[10] = A_DIGI;
	 	seq[11] = OFF;
	 	return 1;
	 case F_FOCU_MANU:
	 	addon_fg = 1;
	  	seq[10] = A_FOCU;		
	  	seq[11] = MANU;
	  	return 1;
	  case F_IRIS_MANU:			
	  	addon_fg = 1;
	  	seq[10] = A_IRIS;
	  	seq[11] = MANU;
	  	return 1;
	  case F_WB_MANU:			
	  	addon_fg = 1;
	  	seq[10] = A_WB;
	  	seq[11] = MANU;
	  	return 1;
	  case F_BLACK:			
	  	addon_fg = 1;
	  	seq[10] = A_BLACK;
	  	seq[11] = OFF;
	  	return 1;
	  case F_FREEZE_OFF:			
	  	addon_fg = 1;
	  	seq[10] = A_FRZE;
	  	seq[11] = OFF;
	  	return 1;
	  case F_MIRRO_OFF:			
	  	addon_fg = 1;
	  	seq[10] = A_MIRR;
	  	seq[11] = OFF;
	  	return 1;
#endif
	  default:
		no = no;
		return 0;
	}
/*
#else
    no = no;
	return 0;
#endif
*/
}


extern bit do_call_addon(unsigned char no)
{
	switch (no)
	{
	case 0x60:
	case 0x61:
	case 0x63:
		run_seq_fg = 0;
		run_swing_fg = 0;
		run_swing2_fg = 1;
		return 1;
	case F_SCAN_RUN:
	    run_swing_fg = 1;
		seq[17] = F_SCAN_START;			//start point
		seq[18] = F_SCAN_END;			//end point
		return 1;
	case F_SCAN_STOP:
		run_swing_fg = 0;
		run_swing2_fg = 0;
		return 1;
	case F_SEQ_RUN:
	    run_seq2_fg = 1;		
		return 1;
#ifndef DIS660
	case F_CAM_POWER:
		power_fg = !power_fg;
		power_on_fg = power_fg;
		power_off_fg = !power_fg;
	    return 1;
	case F_BLC_ON:			
		addon_fg = 1;
		seq[10] = A_BLC;
		seq[11] = ON;
		return 1;
	case F_ZERO_ON:			
		addon_fg = 1;
		seq[10] = A_ZERO;
		seq[11] = ON;
		return 1;
	case F_MENU_ON:			
		disp_on_fg = 1;
		return 1;
	case F_DIGI_ON:			
		addon_fg = 1;
	 	seq[10] = A_DIGI;
	 	seq[11] = ON;
	 	return 1;
	 case F_FOCU_AUTO:
	    addon_fg = 1;
	  	seq[10] = A_FOCU;		
	  	seq[11] = AUTO;
	  	return 1;
	  case F_IRIS_AUTO:		
	  	addon_fg = 1;
	  	seq[10] = A_IRIS;
	  	seq[11] = AUTO;
	  	return 1;
	  case F_WB_AUTO:			
	  	addon_fg = 1;
	  	seq[10] = A_WB;
	  	seq[11] = AUTO;
	  	return 1;
	  case F_COLOR:			
	  	addon_fg = 1;
	  	seq[10] = A_BLACK;
	  	seq[11] = ON;
	  	return 1;
	  case F_FREEZE_ON:			
	  	addon_fg = 1;
	  	seq[10] = A_FRZE;
	  	seq[11] = ON;
	  	return 1;
	  case F_MIRRO_ON:
	  	addon_fg = 1;
	  	seq[10] = A_MIRR;
	  	seq[11] = ON;
	  	return 1;
#endif
	default:
		no = no;
		return 0;
	}
//#else
//    no = no;
//	return 0;
//#endif
}


extern void init_serial(void)
{
	PCON = 0x00;SCON = 0x50;  
#ifdef FOCS_40M	
	TH2 = 0xfd; RCAP2H = 0xfd;
	TL2 = 0xf7; RCAP2L = 0xf7;
#else
    TH2 = 0xfe; RCAP2H = 0xfe;
	TL2 = 0xe0; RCAP2L = 0xe0;
#endif
	T2CON = 0x34;

	rr = word1;
}

void serial_int(void) interrupt 4 using 1
{
	ES = 0;
	if (_testbit_(RI)) (*rr)(SBUF);
	ES = 1;
}