mirror of
				https://github.com/f4exb/sdrangel.git
				synced 2025-10-31 13:00:26 -04:00 
			
		
		
		
	
		
			
				
	
	
		
			161 lines
		
	
	
		
			5.6 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			161 lines
		
	
	
		
			5.6 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| ///////////////////////////////////////////////////////////////////////////////////
 | |
| // Copyright (C) 2016 Edouard Griffiths, F4EXB                                   //
 | |
| //                                                                               //
 | |
| // This program is free software; you can redistribute it and/or modify          //
 | |
| // it under the terms of the GNU General Public License as published by          //
 | |
| // the Free Software Foundation as version 3 of the License, or                  //
 | |
| // (at your option) any later version.                                           //
 | |
| //                                                                               //
 | |
| // This program is distributed in the hope that it will be useful,               //
 | |
| // but WITHOUT ANY WARRANTY; without even the implied warranty of                //
 | |
| // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the                  //
 | |
| // GNU General Public License V3 for more details.                               //
 | |
| //                                                                               //
 | |
| // You should have received a copy of the GNU General Public License             //
 | |
| // along with this program. If not, see <http://www.gnu.org/licenses/>.          //
 | |
| ///////////////////////////////////////////////////////////////////////////////////
 | |
| 
 | |
| #include "util/CRC64.h"
 | |
| 
 | |
| /**
 | |
| * poly is: x^64 + x^62 + x^57 + x^55 + x^54 + x^53 + x^52 + x^47 + x^46 + x^45 + x^40 + x^39 +
 | |
| *          x^38 + x^37 + x^35 + x^33 + x^32 + x^31 + x^29 + x^27 + x^24 + x^23 + x^22 + x^21 +
 | |
| *          x^19 + x^17 + x^13 + x^12 + x^10 + x^9  + x^7  + x^4  + x^1  + 1
 | |
| *
 | |
| * represented here with lsb = highest degree term
 | |
| *
 | |
| * 1100100101101100010101111001010111010111100001110000111101000010_
 | |
| * ||  |  | || ||   | | ||||  | | ||| | ||||    |||    |||| |    | |
 | |
| * ||  |  | || ||   | | ||||  | | ||| | ||||    |||    |||| |    | +- x^64 (implied)
 | |
| * ||  |  | || ||   | | ||||  | | ||| | ||||    |||    |||| |    |
 | |
| * ||  |  | || ||   | | ||||  | | ||| | ||||    |||    |||| |    +--- x^62
 | |
| * ||  |  | || ||   | | ||||  | | ||| | ||||    |||    |||| +-------- x^57
 | |
| * .......................................................................
 | |
| * ||
 | |
| * |+---------------------------------------------------------------- x^1
 | |
| * +----------------------------------------------------------------- x^0 (1)
 | |
| */
 | |
| const uint64_t CRC64::m_poly = 0xC96C5795D7870F42ull;
 | |
| 
 | |
| CRC64::CRC64()
 | |
| {
 | |
| 	build_crc_table();
 | |
| }
 | |
| 
 | |
| CRC64::~CRC64()
 | |
| {}
 | |
| 
 | |
| /**
 | |
| * input is dividend: as 0000000000000000000000000000000000000000000000000000000000000000<8-bit byte>
 | |
| * where the lsb of the 8-bit byte is the coefficient of the highest degree term (x^71) of the dividend
 | |
| * so division is really for input byte * x^64
 | |
| *
 | |
| * you may wonder how 72 bits will fit in 64-bit data type... well as the shift-right occurs, 0's are supplied
 | |
| * on the left (most significant) side ... when the 8 shifts are done, the right side (where the input
 | |
| * byte was placed) is discarded
 | |
| *
 | |
| * when done, table[XX] (where XX is a byte) is equal to the CRC of 00 00 00 00 00 00 00 00 XX
 | |
| */
 | |
| void CRC64::build_crc_table()
 | |
| {
 | |
|     for(int i = 0; i < 256; ++i)
 | |
|     {
 | |
|     	uint64_t crc = i;
 | |
| 
 | |
|     	for(unsigned int j = 0; j < 8; ++j)
 | |
|     	{
 | |
|     		if(crc & 1) // is current coefficient set?
 | |
|             {
 | |
|                 crc >>= 1;   // yes, then assume it gets zero'd (by implied x^64 coefficient of dividend)
 | |
|     			crc ^= m_poly; // and add rest of the divisor
 | |
|             }
 | |
|     		else // no? then move to next coefficient
 | |
|     		{
 | |
|     			crc >>= 1;
 | |
|             }
 | |
|     	}
 | |
| 
 | |
|         m_crcTable[i] = crc;
 | |
|     }
 | |
| }
 | |
| 
 | |
| /**
 | |
| * will give an example CRC calculation for input array {0xDE, 0xAD}
 | |
| *
 | |
| * each byte represents a group of 8 coefficients for 8 dividend terms
 | |
| *
 | |
| * the actual polynomial dividend is:
 | |
| *
 | |
| * = DE       AD       00 00 00 00 00 00 00 00 (hex)
 | |
| * = 11011110 10101101 0000000000000000000...0 (binary)
 | |
| *   || ||||  | | || |
 | |
| *   || ||||  | | || +------------------------ x^71
 | |
| *   || ||||  | | |+-------------------------- x^69
 | |
| *   || ||||  | | +--------------------------- x^68
 | |
| *   || ||||  | +----------------------------- x^66
 | |
| *   || ||||  +------------------------------- x^64
 | |
| *   || ||||
 | |
| *   || |||+---------------------------------- x^78
 | |
| *   || ||+----------------------------------- x^77
 | |
| *   || |+------------------------------------ x^76
 | |
| *   || +------------------------------------- x^75
 | |
| *   |+--------------------------------------- x^73
 | |
| *   +---------------------------------------- x^72
 | |
| *
 | |
| *
 | |
| * the basic idea behind how the table lookup results can be used with one
 | |
| * another is that:
 | |
| *
 | |
| * Mod(A * x^n, P(x)) = Mod(x^n * Mod(A, P(X)), P(X))
 | |
| *
 | |
| * in other words, an input data shifted towards the higher degree terms
 | |
| * changes the pre-computed crc of the input data by shifting it also
 | |
| * the same amount towards higher degree terms (mod the polynomial)
 | |
| *
 | |
| * here is an example:
 | |
| *
 | |
| * 1) input:
 | |
| *
 | |
| *    00 00 00 00 00 00 00 00 AD DE
 | |
| *
 | |
| * 2) index crc table for byte DE (really for dividend 00 00 00 00 00 00 00 00 DE)
 | |
| *
 | |
| *    we get A8B4AFBDC5A6ACA4
 | |
| *
 | |
| * 3) apply that to the input stream:
 | |
| *
 | |
| *    00 00 00 00 00 00 00 00 AD DE
 | |
| *       A8 B4 AF BD C5 A6 AC A4
 | |
| *    -----------------------------
 | |
| *    00 A8 B4 AF BD C5 A6 AC 09
 | |
| *
 | |
| * 4) index crc table for byte 09 (really for dividend 00 00 00 00 00 00 00 00 09)
 | |
| *
 | |
| *    we get 448FCBB7FCB9E309
 | |
| *
 | |
| * 5) apply that to the input stream
 | |
| *
 | |
| *    00 A8 B4 AF BD C5 A6 AC 09
 | |
| *    44 8F CB B7 FC B9 E3 09
 | |
| *    --------------------------
 | |
| *    44 27 7F 18 41 7C 45 A5
 | |
| *
 | |
| */
 | |
| uint64_t CRC64::calculate_crc(uint8_t *stream, int length)
 | |
| {
 | |
|     uint64_t crc = 0;
 | |
| 
 | |
|     for (int i = 0 ; i < length; ++i)
 | |
|     {
 | |
|         uint8_t index = stream[i] ^ crc;
 | |
|         uint64_t lookup = m_crcTable[index];
 | |
| 
 | |
|         crc >>= 8;
 | |
|         crc ^= lookup;
 | |
|     }
 | |
| 
 | |
|     return crc;
 | |
| }
 | |
| 
 | |
| 
 |