裴昌跃 / AGVkunshantaiguang · Files

#include "includes.h"
#include "hardware.h"
#include "all_value.h"




short F_HighInit;

short HighMax;
short Highmin;

float High_Dis;//µ¥Î»mm
void GetHighDis_Pro(void)
{	
	if(VaIndexDW_R(&F_AgvContr,17))//Óвâ¾à
	{	High_Dis=(float)((float)(0x7FFFFF-SSI_Value)*0.02442f+(float)F_HighInit);
		if ( (High_Dis>=Highmin) && (High_Dis<=HighMax) )
			VaIndexW_W(&NodeOnLine,12,1);
		else VaIndexW_W(&NodeOnLine,12,0);
	}

}