Форум arduino.ua

//======================================================================================//
U8	DS2423_getCounters(U8 *vROM, U8 nomCounters)
{
lng				xClk;
U8		data	vB;
	vDS2423_Err=1;							//якщо перевірка буде хибна, то помилка 0х01.
	if (*vROM!=0xFF)						//перевіряю, чи в масиві є S/N.
	{										//в масиві є прописаний S/N, тоді...
		vDS2423_Err++;						//якщо перевірка буде хибна, то помилка 0х02.
		if (*vROM==0x1D)					//перевіряю, чи це S/N датчиків DS2423.
		{									//так, це S/N цих датчиків температури, тоді...
			if (lWire_Macth_ROM(vROM)==0)	// зброс всіх датчиків і передача S/N потрібного датчика.
			{										// якщо вдало, то.....
				vDS2423_Err=0;						// помилок не має.
									lWire_WR(0xA5);	// запис команди "READ_MEM_COUNTER"
				if (nomCounters==0)	lWire_WR(0xC0);	// запис молодшого адресу сторінки лічильника "А"
				else				lWire_WR(0xE0);	// ------------------------------------------ "В"
									lWire_WR(0x01);	// запис старшого  адресу сторінки (16 сторінок по 32 байта)
				for (vB=0;	vB<42;	vB++)	vArrayRAM[vB]=lWire_RD();// зчитую з датчика в буфер vArrayRAM[], 42 байта.
				//........тепер розбираю байти масива vArrayRAM[].....................................................//
				// vArrayRAM[ 0]...vArrayRAM[31] - 32 байта RAM-сторінки.
				xClk.b[3]=vArrayRAM[32];		// 4 байта
				xClk.b[2]=vArrayRAM[33];		// лічильника
				xClk.b[1]=vArrayRAM[34];		//
				xClk.b[0]=vArrayRAM[35];		//
				// vArrayRAM[36]...vArrayRAM[39] - 4 байта з нульовими значеннями.
				// vArrayRAM[40]...vArrayRAM[41] - 2 байта CRC.
				if (xClk.l==0xFFFFFFFF)	vDS2423_Err=2;	// помилка зчитування RAM.
				else									// інакше - все ОК, тоді...
				{
					vDS2423_Counter.l	=xClk.l;		// зберігаю значення лічильника та
					vDS2423_Bat			=((5.0-0.68)*vArrayRAM[24]/256)*1000;// значення батареї живлення DS2423.
				}
			}
			else	vDS2423_Err=lWire_Err;	// помилка збросу датчиків(0х80-лінія зайнята;0х81-датчики відсутні;0х82-лінія зайнята)
		}
	}
 	return(vDS2423_Err);
}
//======================================================================================//

U16 crc16(const U8 * input, U16 len)
{
static const U8 oddparity[16] = { 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0 };
U16 cdata;
U16	xCRC;
U16 iInx;

	xCRC=0;
    for (iInx = 0 ; iInx < len ; iInx++)
    {
      // Even though we're just copying a byte from the input, we'll be doing 16-bit computation with it.
      cdata  = input[iInx];
      cdata  = (cdata ^ xCRC) & 0xFF;
      xCRC >>= 8;

      if (oddparity[cdata & 0x0F] ^ oddparity[cdata >> 4])  xCRC ^= 0xC001;

      cdata <<= 6;
      xCRC   ^= cdata;
      cdata <<= 1;
      xCRC   ^= cdata;
    }
    return xCRC;
}

U16 CalcCRCbyAlgorithm(U8 * pDataBuffer, U16 usDataLen)
{
	/* Use the Modbus algorithm as detailed in the Watlow comms guide */

//const U16 POLYNOMIAL = 0xA001;
const U16 POLYNOMIAL = 0xA001;
U16 wCrc;
U16 iByte, iBit;

	/* Initialize CRC */
	wCrc = 0xFFFF;

	for (iByte = 0; iByte < usDataLen; iByte++)
	{

		wCrc ^= *(pDataBuffer + iByte);		/* Exclusive-OR the byte with the CRC */
		for (iBit = 0; iBit <= 7; iBit++)	/* Loop through all 8 data bits */
		{
			/* If the LSB is 1, shift the CRC and XOR the polynomial mask with the CRC */
			/* Note - the bit test is performed before the rotation, so can't move the << here */
			if (wCrc & 0x0001)
			{
				wCrc >>= 1;
				wCrc  ^= POLYNOMIAL;
			}
			else
			{
				wCrc >>= 1;	/* Just rotate it */
			}
		}
	}
	return wCrc;
}