p_wj-fs616.c

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

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

#define STX 		0x02
#define ETX 		0x03


unsigned char data data1,data2,data3,data4;
unsigned char data hi_addr,lo_addr;

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 word8(unsigned char rc);
void word9(unsigned char rc);
void word10(unsigned char rc);
void word11(unsigned char rc);
void word12(unsigned char rc);
void word13(unsigned char rc);
void word14(unsigned char rc);
void word15(unsigned char rc);
void word16(unsigned char rc);
void word17(unsigned char rc);
void word18(unsigned char rc);

void word1(unsigned char rc) using 1
{
	if (rc == STX) rr = word2;
	run_seq_fg = 0;
	run_seq2_fg = 0;
	run_swing_fg = 0;
}

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

void word3(unsigned char rc) using 1
{
	if (rc != 'D') 
		rr = word1;
	else
		rr = word4;
}

void word4(unsigned char rc) using 1
{
	hi_addr = rc - 0x30;
	if (hi_addr >= 10) 
		rr = word1;
	else
		rr = word5;
}

void word5(unsigned char rc) using 1
{
	lo_addr = rc - 0x30;
	if (lo_addr < 10)
	{
		lo_addr += hi_addr*10;
		if (lo_addr != id) 
			rr = word1;
		else
			rr = word6;
	}
	else
		rr = word1;
}

void word6(unsigned char rc) using 1
{	
	if (rc == ';')
		rr = word7;
	else 
		rr = word1;
}

void word7(unsigned char rc) using 1
{	
	if (rc == 'G') 
		rr = word8;
	else
		rr = word1;
}

void word8(unsigned char rc) using 1
{
	if (rc == 'C')
		rr = word9;
	else
		rr = word1;
}

void word9(unsigned char rc) using 1
{
	if (rc == '7')
		rr = word10;
	else
		rr = word1;
}

void word10(unsigned char rc) using 1
{
	if (rc != ':') 
		rr = word1;
	else
		rr = word11;
}

void word11(unsigned char rc) using 1
{	
	
	if ((rc == '2') || (rc == '0'))
	{
		data1 = rc;
		rr = word12;
	}
	else
		rr = word1;
}

void word12(unsigned char rc) using 1
{
	if (rc == '0')
		rr = word13;
	else
		rr = word1;
}

void word13(unsigned char rc) using 1
{
	if (rc == '2')
		rr = word14;
	else
		rr = word1;
}

void word14(unsigned char rc) using 1
{
	if (rc == '1')
		rr = word15;
	else
		rr = word1;
}

void word15(unsigned char rc) using 1
{
	data2 = rc;
	rr = word16;
}

void word16(unsigned char rc) using 1
{
	data3 = rc;
	rr = word17;
}

void word17(unsigned char rc) using 1
{
	data4 = rc;
	rr = word18;
}

void word18(unsigned char rc) using 1
{
	rr = word1;
	if (rc != ETX) return;

	if (data1 == '0')
	{
		if ((data2 == '0') && (data3 == '0'))
		{
			if (data4 == '2')
				iris_open_fg = 1;
			else if (data4 == '3')
				iris_close_fg = 1;
		}
	}
	else //data1 == 2
	{
		if (data2 == '3')
		{
			if (data3 == '5')
			{
				run_swing2_fg = 0;

				switch(data4)
				{
				case 'C':
					seq[12] = 0x02;
					seq[13] = 40;
					seq[14] = 0;
					cont_fg = 1;
					break;
				case '8':
					seq[12] = 0x04;
					seq[13] = 40;
					seq[14] = 0;
					cont_fg = 1;
					break;
				case 'A':
					seq[12] = 0x08;
					seq[13] = 0;
					seq[14] = 40;
					cont_fg = 1;
					break;
				case 'E':
					seq[12] = 0x10;
					seq[13] = 0;
					seq[14] = 40;
					cont_fg = 1;
					break;
				}
			}
			else if (data3 == '2')
			{
				if (data4 == '4')
				{
					cont_fg = 1;
					seq[12] = 0;
				}
			}
			else if (data3 == '0')
			{
				if (data4 == '0')
					run_swing2_fg = 1;
			}
		}
		else if (data2 == '2')
		{
			if (data3 == '2')
			{
				switch (data4)
				{
				case 'C':
					zoom_wide_fg = 1;
					zoom_need_stop = 1;
					break;
				case '8':
					zoom_tele_fg = 1;
					zoom_need_stop = 1;
					break;
				case 'A':
					focu_far_fg = 1;
					focus_need_stop = 1;
					break;
				case 'E':
					focu_near_fg = 1;
					focus_need_stop = 1;
					break;
				case '4':
					if (_testbit_(zoom_need_stop))
						zoom_stop_fg = 1;
					else if (_testbit_(focus_need_stop))
						focu_stop_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:			//diaplay off
		disp_off_fg = 1;
		return 1;
	case F_DIGI_OFF:
		addon_fg = 1;		//camera digital off
	 	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)
{
//#ifndef DIS660
	switch (no)
	{
	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;  
	TH2 = 0xff; RCAP2H = 0xff;
#ifdef FOCS_40M
	TL2 = 0x7d; RCAP2L = 0x7d;
#else
	TL2 = 0xb8; RCAP2L = 0xb8;
#endif
	T2CON = 0x34;

	rr = word1;
}


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