裴昌跃 / AGVkunshantaiguang · Files

GetHighDis.c 423 Bytes
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 
#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);
	}

}