/standarts/decoders/c/decoder_modulation.c

http://project-static.googlecode.com/ · C · 1085 lines · 205 code · 17 blank · 863 comment · 39 complexity · 4e105fa297b28aac98a12ee9f1ea12d8 MD5 · raw file 

    

  1. /*

    2. 

  2. 

    3. 

  3. 	Author:			KRM

    4. 

  4. 	Compiler:		ANY

    5. 

  5. 	Date creation:	14.09.2010

    6. 

  6. 	Date updated:	03.11.2010	12:08:58

    7. 

  7. 	Description:

    8. 

  8. 	Name:

    9. 

  9. 	Name file:

    10. 

  10. 	Name project:	Static

    11. 

  11. 	Processor:		ANY

    12. 

  12. 	Software:		Eclipse v 3.7 Indigo

    13. 

  13. 	Type:

    14. 

  14. 	Version:		1.00

    15. 

  15. 

    16. 

  16. */

    17. 

  17. #define DECODER_MODULATION_GLOBALS

    18. 

  18. //#include "inc_amcos.h"

    19. 

  19. //#include "LPC11xx.h"

    20. 

  20. //#include <htc.h>

    21. 

  21. #include "..\..\..\common\c\definitions.h"

    22. 

  22. #include "decoder_modulation.h"

    23. 

  23. 

    24. 

  24. 

    25. 

  25. /*

    26. 

  26. ??? ???????? ???????????? ??????? ? ????.

    27. 

  27.   ???????? ???????? - ??????? ?????? ??????

    28. 

  28. 

    29. 

  29. 

    30. 

  30. 

    31. 

  31. unsigned long long decode_am3(unsigned short  iPeriod, unsigned char iMode)

    32. 

  32. {

    33. 

  33. 	static unsigned char i,iCurrentBit,iBitPosition,iCurrenByte;

    34. 

  34. 	static union

    35. 

  35. 	{

    36. 

  36. 		unsigned long long i64bits;

    37. 

  37. 		unsigned char aByte[8];

    38. 

  38. 	} uCodeFromPeriods;

    39. 

  39. 	if ((iMode==12)&&(!i))

    40. 

  40. 	{

    41. 

  41. 		i=2;

    42. 

  42. 		uCodeFromPeriods.aByte[7]=0x40;		// ????? ? ????? ?????? ??????? ???? ???? ???????????????? ??????? ??? iCurentBit

    43. 

  43. 		iCurrentBit=1;

    44. 

  44. 	}

    45. 

  45. 	if (i)

    46. 

  46. 	{

    47. 

  47. 		if ((iPeriod>T_PERIOD_L2_MIN)&&(iPeriod<T_PERIOD_L2_MAX))

    48. 

  48. 		{

    49. 

  49. 			if (iCurrentBit)

    50. 

  50. 			{

    51. 

  51. 				iCurrentBit=0;

    52. 

  52. 				i++;

    53. 

  53. 			}

    54. 

  54. 			else iCurrentBit=1;

    55. 

  55. 		}

    56. 

  56. 		else

    57. 

  57. 		{

    58. 

  58. 			if ((iPeriod>T_PERIOD_L3_MIN)&&(iPeriod<T_PERIOD_L3_MAX))

    59. 

  59. 			{

    60. 

  60. 				iCurrentBit=1;

    61. 

  61. 				i++;

    62. 

  62. 			}

    63. 

  63. 			else

    64. 

  64. 			{

    65. 

  65. 				if (iPeriod>T_PERIOD_L1_MAX)		// ??? ??? ?? ? ???? ?? ?????????? ?? ??????, ????????? ?????????

    66. 

  66. 				{// ????????? ????????? ? ?????? ???? ?????? ?????????????? ?????? ????? ??????

    67. 

  67. 					i=0;		// ???? ?? ?????? ?? ? ???? ???????? - ??????? ?? ???????

    68. 

  68. 					return 0;

    69. 

  69. 				}// ???? ?????? ? ????????? ???????? ?????? ?????? ?? ????

    70. 

  70. 			}

    71. 

  71. 		}

    72. 

  72. 		if (iPeriod>T_PERIOD_L1_MIN)

    73. 

  73. 		{

    74. 

  74. 			iBitPosition=7-(i%8);

    75. 

  75. 			iCurrenByte=7-((unsigned char)(i/8));

    76. 

  76. 			uCodeFromPeriods.aByte[iCurrenByte]|=iCurrentBit<<iBitPosition;

    77. 

  77. 			if (i>62)

    78. 

  78. 			{

    79. 

  79. 				i=0;

    80. 

  80. 				return uCodeFromPeriods.i64bits;

    81. 

  81. 			}

    82. 

  82. 			i++;

    83. 

  83. 			return STATE_RESULT2;

    84. 

  84. 		}

    85. 

  85. 		else return 1;// ???? ?????? ??????? ???????? ?????? ????? ?????? ?????????? 1 ????? ????? ????????? ? ????? ??????? ?????????

    86. 

  86. 	}

    87. 

  87. 	else

    88. 

  88.     {

    89. 

  89. 		// ??? ??? ?? ????? ??????? ??????? ????? ???????? ? ??????????? ?????????????????? 0b10 . ????? ????????? ? 2-??? ????

    90. 

  90. 		if (iMode==RESULT_FOUND_LONG_PULSE)

    91. 

  91. 		{

    92. 

  92. 			i=3;

    93. 

  93. 			if ((iPeriod>T_LOW_L1_MIN)&&(iPeriod<T_LOW_L1_MAX))

    94. 

  94. 			{

    95. 

  95. 				uCodeFromPeriods.i64bits=0x8000000000000000UL;		// ????? ? ????? ?????? ??????? ???? ???? ???????????????? ??????? ??? Curent

    96. 

  96. 				iCurrentBit=0;

    97. 

  97. 			}

    98. 

  98. 			else

    99. 

  99. 			{

    100. 

  100. 				if ((iPeriod>T_LOW_L2_MIN)&&(iPeriod<T_LOW_L2_MAX))

    101. 

  101. 				{

    102. 

  102. 					uCodeFromPeriods.i64bits=0xA000000000000000UL;	// ??? ????

    103. 

  103. 					iCurrentBit=1;

    104. 

  104. 				}

    105. 

  105. 				else

    106. 

  106. 				{

    107. 

  107. 					i=0;

    108. 

  108. 					return 0;

    109. 

  109. 				}

    110. 

  110. 			}

    111. 

  111. 		}

    112. 

  112.     }

    113. 

  113. 	return 2;

    114. 

  114. }

    115. 

  115.  */

    116. 

  116. 

    117. 

  117. 

    118. 

  118. /* TODO

    119. 

  119. ??? ???????? ???????????? ??????? ? ????. ??? ????? ?? ???????????? ? ????? ?? ???????

    120. 

  120.   ???????? ???????? - ??????? ???????? ???????

    121. 

  121. ,unsigned char iMode

    122. 

  122. 

    123. 

  123. unsigned long long decode_am_periods(unsigned short  iPeriod)

    124. 

  124. {

    125. 

  125. 	static unsigned char i,iCurrentBit,iBitPosition,iCurrenByte;

    126. 

  126. 

    127. 

  127. 	static union

    128. 

  128. 	{

    129. 

  129. 		unsigned long long i64bits;

    130. 

  130. 		unsigned char aByte[8];

    131. 

  131. 	} uCodeFromPeriods;

    132. 

  132. 

    133. 

  133. 		if ((iPeriod>T_PERIOD_L2_MIN)&&(iPeriod<T_PERIOD_L2_MAX))

    134. 

  134. 		{

    135. 

  135. 			if (iCurrentBit)

    136. 

  136. 			{

    137. 

  137. 				iCurrentBit=0;

    138. 

  138. 				i++;

    139. 

  139. 			}

    140. 

  140. 			else

    141. 

  141. 			{

    142. 

  142. 				iCurrentBit=1;

    143. 

  143. 			}

    144. 

  144. 		}

    145. 

  145. 		else

    146. 

  146. 		{

    147. 

  147. 			if ((iPeriod>T_PERIOD_L3_MIN)&&(iPeriod<T_PERIOD_L3_MAX))

    148. 

  148. 			{

    149. 

  149. 				iCurrentBit=1;

    150. 

  150. 				i++;

    151. 

  151. 			}

    152. 

  152. 			else

    153. 

  153. 			{

    154. 

  154. 				if (((iPeriod>300)&&(iPeriod<T_PERIOD_L1_MIN))||(iPeriod>T_PERIOD_L1_MAX))		// ??? ??? ?? ? ???? ?? ?????????? ?? ??????, ????????? ?????????

    155. 

  155. 				{// ????????? ????????? ? ?????? ???? ?????? ?????????????? ?????? ????? ??????

    156. 

  156. 					iCurrentBit=i=0;				// ???? ?? ?????? ?? ? ???? ???????? - ??????? ?? ???????

    157. 

  157. 					uCodeFromPeriods.i64bits=0;

    158. 

  158. 					return 0;			// TODO ? ???? ?????? ????????? ??????? iCurrentBit=0; ????????? ??? ??? ????????

    159. 

  159. 				}													// ???? ?????? ? ????????? ???????? ?????? ?????? ?? ????

    160. 

  160. 			}

    161. 

  161. 		}

    162. 

  162. 		if (iPeriod>300)// ???? ?????? ?????????????? ?????? ????? ?????? ?????? ?????????? ??? ???? ????

    163. 

  163. 		{

    164. 

  164. 			iBitPosition=7-(i%8);

    165. 

  165. 			iCurrenByte=7-((unsigned char)(i/8));

    166. 

  166. 			uCodeFromPeriods.aByte[iCurrenByte]|=iCurrentBit<<iBitPosition;

    167. 

  167. 			if (i>62)

    168. 

  168. 			{

    169. 

  169. 				iCurrentBit=i=0;

    170. 

  170. 				return uCodeFromPeriods.i64bits;

    171. 

  171. 			}

    172. 

  172. 			i++;

    173. 

  173. 		}

    174. 

  174. 

    175. 

  175. 	return (unsigned long long) i;

    176. 

  176. }

    177. 

  177.  */

    178. 

  178. /*

    179. 

  179. ??? ???????? ???????????? ??????? ? ????.

    180. 

  180.   ???????? ???????? - ??????? ??????

    181. 

  181. 

    182. 

  182. 

    183. 

  183. unsigned long long decode_am2bits(unsigned short iPeriod, unsigned char iMode, unsigned char bitStateSignal)

    184. 

  184. {

    185. 

  185. 	static unsigned char i,iCurrentBit,iBitPosition,iCurrenByte,fTnext_enable;

    186. 

  186. 	static unsigned short iPeriodSave, iPeriodAfterTnext;

    187. 

  187. 	static union

    188. 

  188. 	{

    189. 

  189. 		unsigned long long i64bits;

    190. 

  190. 		unsigned char aByte[8];

    191. 

  191. 	} uCodeFromPeriods;

    192. 

  192. 	//if ((iPeriod>10000)&&(iPeriod<11000)&& (!bitStateSignal)) return  STATE_RESULT3;// ???????????? ??????? ????? ???????? ????

    193. 

  193. 	if(i==0) uCodeFromPeriods.i64bits=0;

    194. 

  194. 

    195. 

  195. 	if (fTnext_enable==0)

    196. 

  196. 	{

    197. 

  197. 		iPeriod+=iPeriodSave;

    198. 

  198. 		if (iPeriod>T_NEXT)	fTnext_enable=1;

    199. 

  199. 		else				iPeriodSave=iPeriod;

    200. 

  200. 	}

    201. 

  201. 	if (fTnext_enable==1)

    202. 

  202. 	{

    203. 

  203. 		iPeriodAfterTnext=iPeriod-T_NEXT;

    204. 

  204. 		if (iPeriodAfterTnext>T_S2)

    205. 

  205. 		{

    206. 

  206. 			fTnext_enable=0;

    207. 

  207. 			iPeriodAfterTnext=iPeriodSave=0;

    208. 

  208. 			i=0;

    209. 

  209. 			uCodeFromPeriods.i64bits=0;

    210. 

  210. 			return 0;

    211. 

  211. 		}

    212. 

  212. 		iCurrentBit=bitStateSignal;

    213. 

  213. 		iBitPosition=7-					(i%8);

    214. 

  214. 		iCurrenByte	=7-((unsigned char)	(i/8));

    215. 

  215. 		uCodeFromPeriods.aByte[iCurrenByte]|=iCurrentBit<<iBitPosition;

    216. 

  216. 		fTnext_enable=0;

    217. 

  217. 		iPeriodAfterTnext=iPeriodSave=0;		

    218. 

  218. 		if (i>62)

    219. 

  219. 		{

    220. 

  220. 			fTnext_enable=i=0;

    221. 

  221. 			return uCodeFromPeriods.i64bits;

    222. 

  222. 		}

    223. 

  223. 		i++;

    224. 

  224. 	}

    225. 

  225. 	return STATE_RESULT2;

    226. 

  226. }

    227. 

  227.  */

    228. 

  228. 

    229. 

  229. /*

    230. 

  230. 	 ?????????? ?? ???????? ???? ??????????,

    231. 

  231. 	???? ?? ????????? 96 ?????? ?? ??????? ????????? 1. ???? ????????? ?? ??????? ?????????? ??????? ?????????????????? ???? ?????????? ? ????

    232. 

  232. 	01 = 0

    233. 

  233. 	10 = 1

    234. 

  234. 	? ?????? ????? ??????? ?????? ???????? ?? ??????? ????????? ??????? ?????????? 0

    235. 

  235. 	? ?????????? ????? ?????????? ?? ???? ???????

    236. 

  236. 

    237. 

  237. unsigned long * decode_fm2manchester(unsigned short iPeriod,unsigned short iTPeriodLowMin,unsigned short iTPeriodLowMax,unsigned short iTPeriodHighMin,unsigned short iTPeriodHighMax)

    238. 

  238. {

    239. 

  239. 	unsigned long *plReturn;

    240. 

  240. 	unsigned long lReturn;

    241. 

  241. 	unsigned char j;

    242. 

  242. 	plReturn=&lReturn;

    243. 

  243. 	if ((iPeriod>iTPeriodLowMin)&&(iPeriod<iTPeriodLowMax))  // ????????? ?????? ??????? ??? ???? ? ??

    244. 

  244. 	{

    245. 

  245. 		if (iCurrentState) iStateChange=1;			// TODO ?? ?????? ??????? ????? ???????? ???? ???????? ??????

    246. 

  246. 		iCurrentState=0;

    247. 

  247. 	}

    248. 

  248. 	else

    249. 

  249. 	{

    250. 

  250. 		if ((iPeriod>iTPeriodHighMin)&&(iPeriod<iTPeriodHighMax))  // ????????? ??????? ??????? ??? ???? ? ??

    251. 

  251. 		{

    252. 

  252. 			if (!iCurrentState)	iStateChange=1;

    253. 

  253. 			iCurrentState=1;

    254. 

  254. 		}

    255. 

  255. 		else

    256. 

  256. 		{

    257. 

  257. 			iCounterPeriodsInDecode=iCounterManchBits=0;

    258. 

  258. 			*plReturn=0;

    259. 

  259. 			return plReturn;

    260. 

  260. 		}

    261. 

  261. 	}

    262. 

  262. 

    263. 

  263. 	if (iStateChange)			 // ???? ????????? ??????? ??????????

    264. 

  264. 	{

    265. 

  265. 		iStateChange=0;

    266. 

  266. 

    267. 

  267. 		for (j=1;j<5;j++)

    268. 

  268. 		{

    269. 

  269. 			if (iCounterPeriodsInDecode>(j*(4+iCurrentState)-1))

    270. 

  270. 			{

    271. 

  271. 				iPosition=31-(iCounterManchBits%32);

    272. 

  272. 				iCurrentByte=32-((unsigned char)(iCounterManchBits>>5)); //??????? ?? 32

    273. 

  273. 				if	(iCurrentState) aCodeManchester[iCurrentByte]&=~(1<<iPosition);

    274. 

  274. 				else			aCodeManchesters[iCurrentByte]|= (1<<iPosition);

    275. 

  275. 				if (iCounterManchBits>94)

    276. 

  276. 				{

    277. 

  277. 					iCounterPeriodsInDecode=iCounterManchBits=0;

    278. 

  278. 					return &aCodeManchester[0];			// ?????????? ????????????????????? ???, ????? ??????? ???????? ???????, ??? ??? ? ??????? ??? ???????? ??????????

    279. 

  279. 				}

    280. 

  280. 				iCounterManchBits++;

    281. 

  281. 			}

    282. 

  282. 		}

    283. 

  283. 		iCounterPeriodsInDecode=0;

    284. 

  284. 	}

    285. 

  285. 	iCounterPeriodsInDecode++;

    286. 

  286. 	*plReturn=1;

    287. 

  287. 	return plReturn; // ?????????? 1 ??????? ???? ??? ??? ??? ????????????????? ?? ??????? ??????? ? ?????????

    288. 

  288. }

    289. 

  289. */

    290. 

  290.  /*

    291. 

  291.  	 ?????????? ?? ???????? ???? ??????????,

    292. 

  292.  	???? ?? ????????? 96 ?????? ?? ??????? ????????? 1. ???? ????????? ?? ??????? ?????????? ??????? ?????????????????? ???? ?????????? ? ????

    293. 

  293.  	01 = 0

    294. 

  294.  	10 = 1

    295. 

  295.  	? ?????? ????? ??????? ?????? ???????? ?? ??????? ????????? ??????? ?????????? 0

    296. 

  296.  	? ?????????? ????? ?????????? ?? ???? ???????

    297. 

  297. 

    298. 

  298.  	PIC18F14K50 (40 ???) ??????????? ?? 33 ???)

    299. 

  299. 

    300. 

  300.  unsigned char decode8_fm2manchester(unsigned char iCodeLength,unsigned char iNumberArray, unsigned short iPeriod,unsigned short iTPeriodBoundary,unsigned short iTPeriodHighMax)

    301. 

  301.  {

    302. 

  302.  	unsigned char j;

    303. 

  303.  	static unsigned char iCounterManchBits,iCounterPeriodsInDecode,iPosition,iCurrentByte,iCurrentState, iStateChange;

    304. 

  304.  	if (iPeriod<iTPeriodBoundary)  // ????????? ?????? ??????? ??? ???? ? ??

    305. 

  305.  	{

    306. 

  306.  		if (iCurrentState) iStateChange=1;			// TODO ?? ?????? ??????? ????? ???????? ???? ???????? ??????

    307. 

  307.  		iCurrentState=0;

    308. 

  308.  	}

    309. 

  309.  	else

    310. 

  310.  	{

    311. 

  311.  		if (iPeriod<iTPeriodHighMax)  // ????????? ??????? ??????? ??? ???? ? ??

    312. 

  312.  		{

    313. 

  313.  			if (!iCurrentState)	iStateChange=1;

    314. 

  314.  			iCurrentState=1;

    315. 

  315.  		}

    316. 

  316.  		else

    317. 

  317.  		{

    318. 

  318.  			iCounterPeriodsInDecode=iCounterManchBits=0; // ????? ??? ??????????? ????????? ??????? ?????? ?? 2 ? ???????? 2 ????????

    319. 

  319.  			return 0;

    320. 

  320.  		}

    321. 

  321.  	}

    322. 

  322.  	if (iStateChange)			 // ???? ????????? ??????? ??????????

    323. 

  323.  	{

    324. 

  324.  		iStateChange=0;

    325. 

  325.  		if (iCounterPeriodsInDecode==1) return 0;

    326. 

  326. 

    327. 

  327.  		if (iCounterPeriodsInDecode>(4+iCurrentState))

    328. 

  328.  		{

    329. 

  329. 			iPosition=7-(iCounterManchBits&7);

    330. 

  330. 			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    331. 

  331. 

    332. 

  332. 			if	(iCurrentState) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    333. 

  333. 			else				{ aCodeManchester[iNumberArray][iCurrentByte]&=~(1<<iPosition); }

    334. 

  334. 

    335. 

  335. 			if (iCounterManchBits>iCodeLength)

    336. 

  336. 			{

    337. 

  337. 				iCounterPeriodsInDecode=iCounterManchBits=0;

    338. 

  338. 				return 0x10;			// ????? ?? ?????????? ??? ?????? ??? ??? ?? ?? ????? ????????? ??????? ??????

    339. 

  339. 			}

    340. 

  340. 			iCounterManchBits++;

    341. 

  341.  		}

    342. 

  342. 

    343. 

  343.  		if (iCounterPeriodsInDecode>(8+(iCurrentState<<1))) // ?? ????? ???? ?????? ????  8 ?? 1 ??? ???????? ??? ???????? ??????

    344. 

  344.  		{

    345. 

  345. 			iPosition=7-(iCounterManchBits&7);

    346. 

  346. 			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    347. 

  347. 			if	(iCurrentState) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    348. 

  348. 			else				{ aCodeManchester[iNumberArray][iCurrentByte]&=~(1<<iPosition); }

    349. 

  349. 			if (iCounterManchBits>iCodeLength)

    350. 

  350. 			{

    351. 

  351. 				iCounterPeriodsInDecode=iCounterManchBits=0;

    352. 

  352. 				return 0x10;

    353. 

  353. 			}

    354. 

  354. 			iCounterManchBits++;

    355. 

  355.  		}

    356. 

  356. 

    357. 

  357.  		if (iCounterPeriodsInDecode>(12+((iCurrentState<<1)|iCurrentState)))// ??????? iCurrentState *3

    358. 

  358.  		{

    359. 

  359. 			iPosition=7-(iCounterManchBits&7);

    360. 

  360. 			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    361. 

  361. 			if	(iCurrentState) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    362. 

  362. 			else				{ aCodeManchester[iNumberArray][iCurrentByte]&=~(1<<iPosition); }

    363. 

  363. 			if (iCounterManchBits>iCodeLength)

    364. 

  364. 			{

    365. 

  365. 				iCounterPeriodsInDecode=iCounterManchBits=0;

    366. 

  366. 				return 0x10;

    367. 

  367. 			}

    368. 

  368. 			iCounterManchBits++;

    369. 

  369.  		}

    370. 

  370.  		iCounterPeriodsInDecode=0;

    371. 

  371.  	}

    372. 

  372.  	iCounterPeriodsInDecode++;

    373. 

  373.  	return 1; // ?????????? 1 ??????? ???? ??? ??? ??? ????????????????? ?? ??????? ??????? ? ?????????

    374. 

  374.  }

    375. 

  375.  */

    376. 

  376.  /*

    377. 

  377.   	 ?????????? ?? ???????? ???? ??????????,

    378. 

  378.   	???? ?? ????????? 96 ?????? ?? ??????? ????????? 1. ???? ????????? ?? ??????? ?????????? ??????? ?????????????????? ???? ?????????? ? ????

    379. 

  379.   	01 = 0

    380. 

  380.   	10 = 1

    381. 

  381.   	? ?????? ????? ??????? ?????? ???????? ?? ??????? ????????? ??????? ?????????? 0

    382. 

  382.   	? ?????????? ????? ?????????? ?? ???? ???????

    383. 

  383. 

    384. 

  384.   	PIC18F14K50 (40 ???) ??????????? ?? 33 ???)

    385. 

  385.   */

    386. 

  386. unsigned char decode8_fm2manchester2(unsigned char iCodeLength,unsigned char iNumberArray, unsigned short iPeriodCur,unsigned short iTPeriodBoundary,unsigned short iTPeriodHighMax)

    387. 

  387. {

    388. 

  388.   	unsigned char j, iStateChange=0,iPosition=0,iCurrentByte=0,iCurrentManchBit=0;// ????????? ?? ? decode8_fm2manchester

    389. 

  389.   	static unsigned char iCurrentState,iCounterManchBits,iCounterPeriodsDecoding,iCounterHighBits,iCounterLowBits;// static ?? ? decode8_fm2manchester

    390. 

  390. 

    391. 

  391.   	if (iPeriodCur<iTPeriodBoundary)  // ????????? ?????? ??????? ??? ???? ? ??

    392. 

  392.   	{

    393. 

  393.   		if (iCurrentState)

    394. 

  394. 		{

    395. 

  395. 			iStateChange=1;			// TODO ?? ?????? ??????? ????? ???????? ???? ???????? ??????

    396. 

  396. 		}

    397. 

  397. 		iCurrentState=0;

    398. 

  398.   		iCounterLowBits++;

    399. 

  399.   	}

    400. 

  400.   	else

    401. 

  401.   	{

    402. 

  402.   		if (iPeriodCur<iTPeriodHighMax)  // ????????? ??????? ??????? ??? ???? ? ??

    403. 

  403.   		{

    404. 

  404.   			if (!iCurrentState)

    405. 

  405.   			{

    406. 

  406.   				iStateChange=1;

    407. 

  407.   			}

    408. 

  408. 			iCurrentState=1;

    409. 

  409.   			iCounterHighBits++;

    410. 

  410.   		}

    411. 

  411.   		else

    412. 

  412.   		{

    413. 

  413.   			iCounterHighBits=iCounterLowBits=iCounterPeriodsDecoding=iCounterManchBits=0; // ????? ??? ??????????? ????????? ??????? ?????? ?? 2 ? ???????? 2 ????????

    414. 

  414.   			return 0;

    415. 

  415.   		}

    416. 

  416.   	}

    417. 

  417. 

    418. 

  418.   	if (iStateChange)			 // ???? ????????? ??????? ??????????

    419. 

  419.   	{

    420. 

  420.   		iStateChange=0;

    421. 

  421.   		if (iCounterLowBits>iCounterHighBits)

    422. 

  422.   		{

    423. 

  423.   			iCounterPeriodsDecoding=iCounterLowBits;

    424. 

  424.   			iCounterLowBits=0;

    425. 

  425.   			iCurrentManchBit=0;

    426. 

  426.   		}

    427. 

  427.   		else

    428. 

  428.   		{

    429. 

  429.   			iCounterPeriodsDecoding=iCounterHighBits;

    430. 

  430.   			iCounterHighBits=0;

    431. 

  431.   			iCurrentManchBit=1;

    432. 

  432.   		}

    433. 

  433. 

    434. 

  434.   		if (iCounterPeriodsDecoding>(3+iCurrentState))

    435. 

  435.   		{

    436. 

  436.  			iPosition=7-(iCounterManchBits&7);		// 7 - ??????? ?? ??????? ?? 8

    437. 

  437.  			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    438. 

  438.  			if (iCurrentManchBit) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    439. 

  439.  			else 				  { aCodeManchester[iNumberArray][iCurrentByte]&= ~(1<<iPosition); }

    440. 

  440.  			if (iCounterManchBits>iCodeLength)

    441. 

  441.  			{

    442. 

  442.  				iCounterHighBits=iCounterLowBits=iCounterPeriodsDecoding=iCounterManchBits=0;

    443. 

  443.   				return 0x10;			// ????? ?? ?????????? ??? ?????? ??? ??? ?? ?? ????? ????????? ??????? ??????

    444. 

  444.  			}

    445. 

  445.  			iCounterManchBits++;

    446. 

  446.   		}

    447. 

  447. 

    448. 

  448.   		if (iCounterPeriodsDecoding>(8+(iCurrentState<<1))) // ?? ????? ???? ?????? ????  8 ?? 1 ??? ???????? ??? ???????? ??????

    449. 

  449.   		{

    450. 

  450.  			iPosition=7-(iCounterManchBits&7);		// 7 - ??????? ?? ??????? ?? 8

    451. 

  451.  			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    452. 

  452.  			if (iCurrentManchBit) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    453. 

  453.  			else 				  { aCodeManchester[iNumberArray][iCurrentByte]&= ~(1<<iPosition); }

    454. 

  454.  			if (iCounterManchBits>iCodeLength)

    455. 

  455.  			{

    456. 

  456.  				iCounterHighBits=iCounterLowBits=iCounterPeriodsDecoding=iCounterManchBits=0;

    457. 

  457.  				return 0x10;

    458. 

  458.  			}

    459. 

  459.  			iCounterManchBits++;

    460. 

  460.   		}

    461. 

  461. 

    462. 

  462.   		if (iCounterPeriodsDecoding>(13+((iCurrentState<<1)|iCurrentState)))// ??????? iCurrentState *3

    463. 

  463.   		{

    464. 

  464.  			iPosition=7-(iCounterManchBits&7);		// 7 - ??????? ?? ??????? ?? 8

    465. 

  465.  			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    466. 

  466.  			if (iCurrentManchBit) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    467. 

  467.  			else 				  { aCodeManchester[iNumberArray][iCurrentByte]&= ~(1<<iPosition); }

    468. 

  468.  			if (iCounterManchBits>iCodeLength)

    469. 

  469.  			{

    470. 

  470.  				iCounterHighBits=iCounterLowBits=iCounterPeriodsDecoding=iCounterManchBits=0;

    471. 

  471.  				return 0x10;

    472. 

  472.  			}

    473. 

  473.  			iCounterManchBits++;

    474. 

  474.   		}

    475. 

  475.   		if (iCounterPeriodsDecoding>(18+(iCurrentState<<2)))// ? ???? ?????????? ????? ???? 4 ???? ?????? ??? ??? ?? ????????? ????? ???????? ??????? ?????? ??????? 000

    476. 

  476.   		{

    477. 

  477.  			iPosition=7-(iCounterManchBits&7);		// 7 - ??????? ?? ??????? ?? 8

    478. 

  478.  			iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    479. 

  479.  			if (iCurrentManchBit) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    480. 

  480.  			else 				  { aCodeManchester[iNumberArray][iCurrentByte]&= ~(1<<iPosition); }

    481. 

  481.  			if (iCounterManchBits>iCodeLength)

    482. 

  482.  			{

    483. 

  483.  				iCounterHighBits=iCounterLowBits=iCounterPeriodsDecoding=iCounterManchBits=0;

    484. 

  484.  				return 0x10;

    485. 

  485.  			}

    486. 

  486.  			iCounterManchBits++;

    487. 

  487.   		}

    488. 

  488.   		iCounterPeriodsDecoding=0;

    489. 

  489.   	}

    490. 

  490.   	return 1; // ?????????? 1 ??????? ???? ??? ??? ??? ????????????????? ?? ??????? ??????? ? ?????????

    491. 

  491. }

    492. 

  492. 

    493. 

  493. /*

    494. 

  494.   	 ?????????? ?? ???????? ???? ??????????,

    495. 

  495.   	???? ?? ????????? 96 ?????? ?? ??????? ????????? 1. ???? ????????? ?? ??????? ?????????? ??????? ?????????????????? ???? ?????????? ? ????

    496. 

  496.   	01 = 0

    497. 

  497.   	10 = 1

    498. 

  498.   	? ?????? ????? ??????? ?????? ???????? ?? ??????? ????????? ??????? ?????????? 0

    499. 

  499.   	? ?????????? ????? ?????????? ?? ???? ???????

    500. 

  500. 

    501. 

  501.   	PIC18F14K50 (40 ???) ??????????? ?? 33 ???)

    502. 

  502. 

    503. 

  503. unsigned char decode8_fm2manchester3(unsigned char iCodeLength,unsigned char iNumberArray, unsigned int iPeriodCur,unsigned int iTPeriodBoundary,unsigned int iTPeriodHighMax)

    504. 

  504. {

    505. 

  505.   	unsigned char j, iStateChange=0,iPosition=0,iCurrentByte=0;// ????????? ?? ? decode8_fm2manchester

    506. 

  506.   	if (iPeriodCur<iTPeriodBoundary)  // ????????? ?????? ??????? ??? ???? ? ??, ?????? ?? 55 ??? ???????? ?? ????? ?????? ??????

    507. 

  507.   	{

    508. 

  508.   		iCounterLowBits++;

    509. 

  509.  		if (iCurrentState)

    510. 

  510.  		{

    511. 

  511.  			iStateChange=1;			// TODO ?? ?????? ??????? ????? ???????? ???? ???????? ??????

    512. 

  512.  		}

    513. 

  513.   	}

    514. 

  514.   	else

    515. 

  515.   	{

    516. 

  516.   		if (iPeriodCur<iTPeriodHighMax)  // ????????? ??????? ??????? ??? ???? ? ??

    517. 

  517.   		{

    518. 

  518.   			iCounterHighBits++;

    519. 

  519.   			if (!iCurrentState)

    520. 

  520.   			{

    521. 

  521.   				iStateChange=1;

    522. 

  522.   			}

    523. 

  523.   		}

    524. 

  524.   		else

    525. 

  525.   		{

    526. 

  526.   			iCounterHighBits=iCounterPeriodsDecoding=iCounterManchBits=0; // ????? ??? ??????????? ????????? ??????? ?????? ?? 2 ? ???????? 2 ????????

    527. 

  527.   			return 0;

    528. 

  528.   		}

    529. 

  529.   	}

    530. 

  530. 

    531. 

  531.   	if (iStateChange)			 // ???? ????????? ??????? ??????????

    532. 

  532.   	{

    533. 

  533.   		iStateChange=0;

    534. 

  534.   		if (iCounterLowBits>iCounterHighBits)

    535. 

  535.   		{

    536. 

  536.   			iCounterPeriodsDecoding=iCounterLowBits;

    537. 

  537.   			iCounterLowBits=0;

    538. 

  538.   			iCurrentState=0;

    539. 

  539.   		}

    540. 

  540.   		else

    541. 

  541.   		{

    542. 

  542.   			iCounterPeriodsDecoding=iCounterHighBits;

    543. 

  543.   			iCounterHighBits=0;

    544. 

  544.   			iCurrentState=1;

    545. 

  545.   		}

    546. 

  546. 		if (iCounterPeriodsDecoding>(4+iCurrentState))

    547. 

  547. 		{

    548. 

  548. 			if (iCounterPeriodsDecoding<(7+(iCurrentState<<1)))

    549. 

  549. 			{

    550. 

  550. 				iPosition=7-(iCounterManchBits&7);

    551. 

  551. 				iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    552. 

  552. 				if	(iCurrentState) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    553. 

  553. 				if (iCounterManchBits>iCodeLength)

    554. 

  554. 				{

    555. 

  555. 					iCounterPeriodsDecoding=iCounterManchBits=0;

    556. 

  556. 					return 0x10;			// ????? ?? ?????????? ??? ?????? ??? ??? ?? ?? ????? ????????? ??????? ??????

    557. 

  557. 				}

    558. 

  558. 				iCounterManchBits++;

    559. 

  559. 			}

    560. 

  560. 			else

    561. 

  561. 			{

    562. 

  562. 				if (iCounterPeriodsDecoding<(11+((iCurrentState<<1)|iCurrentState))) // ?? ????? ???? ?????? ????  8 ?? 1 ??? ???????? ??? ???????? ??????

    563. 

  563. 				{

    564. 

  564. 					iPosition=7-(iCounterManchBits&7);

    565. 

  565. 					iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    566. 

  566. 					if	(iCurrentState) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    567. 

  567. 					if (iCounterManchBits>iCodeLength)

    568. 

  568. 					{

    569. 

  569. 						iCounterPeriodsDecoding=iCounterManchBits=0;

    570. 

  570. 						return 0x10;

    571. 

  571. 					}

    572. 

  572. 					iCounterManchBits++;

    573. 

  573. 				}

    574. 

  574. 				else

    575. 

  575. 				{

    576. 

  576. 					iPosition=7-(iCounterManchBits&7);		// ? ?????? ??????? ??????? ?? ??????? ?? 8

    577. 

  577. 					iCurrentByte=11-(iCounterManchBits>>3);// ??????? ?? 8

    578. 

  578. 					if	(iCurrentState) { aCodeManchester[iNumberArray][iCurrentByte]|= (1<<iPosition); }

    579. 

  579. 

    580. 

  580. 					if (iCounterManchBits>iCodeLength)

    581. 

  581. 					{

    582. 

  582. 						iCounterPeriodsDecoding=iCounterManchBits=0;

    583. 

  583. 						return 0x10;

    584. 

  584. 					}

    585. 

  585. 					iCounterManchBits++;

    586. 

  586. 				}

    587. 

  587. 			}

    588. 

  588. 		}

    589. 

  589.   	}

    590. 

  590.   	return 1; // ?????????? 1 ??????? ???? ??? ??? ??? ????????????????? ?? ??????? ??????? ? ?????????

    591. 

  591. }

    592. 

  592. 

    593. 

  593.   */

    594. 

  594.  /*

    595. 

  595.  	 ?????????? ?? ???????? ???? ??????????,

    596. 

  596.  	???? ?? ????????? 96 ?????? ?? ??????? ????????? 1. ???? ????????? ?? ??????? ?????????? ??????? ?????????????????? ???? ?????????? ? ????

    597. 

  597.  	01 = 0

    598. 

  598.  	10 = 1

    599. 

  599.  	? ?????? ????? ??????? ?????? ???????? ?? ??????? ????????? ??????? ?????????? 0

    600. 

  600.  	? ?????????? ????? ?????????? ?? ???? ???????

    601. 

  601. 

    602. 

  602.  	PIC18F14K50 (40 ???) ??????????? ?? 72 ???)

    603. 

  603. 

    604. 

  604.  unsigned char decode32_fm2manchester(unsigned short iPeriod,unsigned short iTPeriodBoundary,unsigned short iTPeriodHighMax)

    605. 

  605.  {

    606. 

  606.  	unsigned char j;

    607. 

  607.  	if (iPeriod<iTPeriodBoundary)  // ????????? ?????? ??????? ??? ???? ? ??

    608. 

  608.  	{

    609. 

  609.  		if (iCurrentState) iStateChange=1;			// TODO ?? ?????? ??????? ????? ???????? ???? ???????? ??????

    610. 

  610.  		iCurrentState=0;

    611. 

  611.  	}

    612. 

  612.  	else

    613. 

  613.  	{

    614. 

  614.  		if (iPeriod<iTPeriodHighMax)  // ????????? ??????? ??????? ??? ???? ? ??

    615. 

  615.  		{

    616. 

  616.  			if (!iCurrentState)	iStateChange=1;

    617. 

  617.  			iCurrentState=1;

    618. 

  618.  		}

    619. 

  619.  		else

    620. 

  620.  		{

    621. 

  621.  			iCounterPeriodsInDecode=iCounterManchBits=0; // ????? ??? ??????????? ????????? ??????? ?????? ?? 2 ? ???????? 2 ????????

    622. 

  622.  			return 0;

    623. 

  623.  		}

    624. 

  624.  	}

    625. 

  625. 

    626. 

  626.  	if (iStateChange)			 // ???? ????????? ??????? ??????????

    627. 

  627.  	{

    628. 

  628.  		iStateChange=0;

    629. 

  629.  		if (iCounterPeriodsInDecode==1) return 0;

    630. 

  630.  		if (iCounterPeriodsInDecode>(2+iCurrentState))

    631. 

  631.  		{

    632. 

  632.  			iPosition=31-(iCounterManchBits%32);

    633. 

  633.  			iCurrentByte=2-((unsigned char)(iCounterManchBits>>5));// ??????? ?? 32

    634. 

  634.  			if	(iCurrentState) aCodeManchester[iCurrentByte]&=~(1<<iPosition);

    635. 

  635.  			else				aCodeManchester[iCurrentByte]|= (1<<iPosition);

    636. 

  636.  			if (iCounterManchBits>94)

    637. 

  637.  			{

    638. 

  638.  				iCounterPeriodsInDecode=iCounterManchBits=0;

    639. 

  639.  				return 0x10;			// ?????????? ????????????????????? ???, ????? ??????? ???????? ???????, ??? ??? ? ??????? ??? ???????? ??????????

    640. 

  640.  			}

    641. 

  641.  			iCounterManchBits++;

    642. 

  642.  		}

    643. 

  643.  		if (iCounterPeriodsInDecode>(7+(iCurrentState<<1))) // ?? ????? ???? ?????? ????  8 ?? 1 ??? ???????? ??? ???????? ??????

    644. 

  644.  		{

    645. 

  645.  			iPosition=31-(iCounterManchBits%32);

    646. 

  646.  			iCurrentByte=2-((unsigned char)(iCounterManchBits>>5));// ??????? ?? 32

    647. 

  647.  			if	(iCurrentState) aCodeManchester[iCurrentByte]&=~(1<<iPosition);

    648. 

  648.  			else				aCodeManchester[iCurrentByte]|= (1<<iPosition);

    649. 

  649.  			if (iCounterManchBits>94)

    650. 

  650.  			{

    651. 

  651.  				iCounterPeriodsInDecode=iCounterManchBits=0;

    652. 

  652.  				return 0x10;			// ?????????? ????????????????????? ???, ????? ??????? ???????? ???????, ??? ??? ? ??????? ??? ???????? ??????????

    653. 

  653.  			}

    654. 

  654.  			iCounterManchBits++;

    655. 

  655.  		}

    656. 

  656. 

    657. 

  657.  		if (iCounterPeriodsInDecode>(11+((iCurrentState<<1)|iCurrentState)))// ??????? iCurrentState *3

    658. 

  658.  		{

    659. 

  659.  			iPosition=31-(iCounterManchBits%32);

    660. 

  660.  			iCurrentByte=2-((unsigned char)(iCounterManchBits>>5));// ??????? ?? 32

    661. 

  661.  			if	(iCurrentState) aCodeManchester[iCurrentByte]&=~(1<<iPosition);

    662. 

  662.  			else				aCodeManchester[iCurrentByte]|= (1<<iPosition);

    663. 

  663.  			if (iCounterManchBits>94)

    664. 

  664.  			{

    665. 

  665.  				iCounterPeriodsInDecode=iCounterManchBits=0;

    666. 

  666.  				return 0x10;			// ?????????? ????????????????????? ???, ????? ??????? ???????? ???????, ??? ??? ? ??????? ??? ???????? ??????????

    667. 

  667.  			}

    668. 

  668.  			iCounterManchBits++;

    669. 

  669.  		}

    670. 

  670.  		iCounterPeriodsInDecode=0;

    671. 

  671.  	}

    672. 

  672.  	iCounterPeriodsInDecode++;

    673. 

  673.  	return 1; // ?????????? 1 ??????? ???? ??? ??? ??? ????????????????? ?? ??????? ??????? ? ?????????

    674. 

  674.  }

    675. 

  675.  */

    676. 

  676. /*

    677. 

  677. 	 ?????????? ?? ?????? ????????? ??????? ???? ??????????,

    678. 

  678. 	???? ?? ????????? 96 ?????? ?? ??????? ????????? 1. ???? ????????? ?? ??????? ?????????? ??????? ?????????????????? ???? ?????????? ? ????

    679. 

  679. 	01 = 0

    680. 

  680. 	10 = 1

    681. 

  681. 	? ?????? ????? ??????? ?????? ???????? ?? ??????? ????????? ??????? ?????????? 0

    682. 

  682. 	? ?????????? ????? ?????????? ?? ???? ???????

    683. 

  683. 

    684. 

  684. unsigned long * decode_fm_flag2manchester(unsigned char iFlag)

    685. 

  685. {

    686. 

  686. 	unsigned long *plReturn;

    687. 

  687. 	unsigned long lReturn;

    688. 

  688. 	unsigned char j;

    689. 

  689. 	plReturn=&lReturn;

    690. 

  690. 		if (iFlag)  // ????????? ??????? ??????? ??? ???? ? ??

    691. 

  691. 		{

    692. 

  692. 			if (!iCurrentState)	iStateChange=1;

    693. 

  693. 			iCurrentState=1;

    694. 

  694. 		}

    695. 

  695. 		else

    696. 

  696. 		{

    697. 

  697. 			if (iCurrentState) iStateChange=1;			// TODO ?? ?????? ??????? ????? ???????? ???? ???????? ??????

    698. 

  698. 			iCurrentState=0;

    699. 

  699. 		}

    700. 

  700. 	if (iStateChange)			 // ???? ????????? ??????? ??????????

    701. 

  701. 	{

    702. 

  702. 		iStateChange=0;

    703. 

  703. 		for (j=1;j<5;j++)

    704. 

  704. 		{

    705. 

  705. 			if (iCounterPeriodsInDecode>(j*(4+iCurrentState)-1))

    706. 

  706. 			{

    707. 

  707. 				iPosition=31-(iCounterManchBits%32);

    708. 

  708. 				iCurrentByte=3-((unsigned char)(iCounterManchBits/32));

    709. 

  709. 				if	(iCurrentState) aCodeManchester[0][iCurrentByte]&=~(1<<iPosition);

    710. 

  710. 				else				aCodeManchester[0][iCurrentByte]|= (1<<iPosition);

    711. 

  711. 				if (iCounterManchBits>94)

    712. 

  712. 				{

    713. 

  713. 					iCounterPeriodsInDecode=iCounterManchBits=0;

    714. 

  714. 					return (unsigned long *)&aCodeManchester[0][0];			// ?????????? ????????????????????? ???, ????? ??????? ???????? ???????, ??? ??? ? ??????? ??? ???????? ??????????

    715. 

  715. 				}

    716. 

  716. 				iCounterManchBits++;

    717. 

  717. 			}

    718. 

  718. 		}

    719. 

  719. 		iCounterPeriodsInDecode=0;

    720. 

  720. 	}

    721. 

  721. 	iCounterPeriodsInDecode++;

    722. 

  722. 	*plReturn=1;

    723. 

  723. 	return plReturn; // ?????????? 1 ??????? ???? ??? ??? ??? ????????????????? ?? ??????? ??????? ? ?????????

    724. 

  724. }

    725. 

  725. */

    726. 

  726. /*

    727. 

  727. 	??????? ??? ?????? ????????? ?? ???? ???? 0x1D

    728. 

  728. 	??????????? ????? ?????

    729. 

  729. 	TODO ?????? ????? ??? ??????? ? ?????????? ????? ???????

    730. 

  730. */

    731. 

  731. unsigned char search_header_fm(unsigned char *psCodeFromPeriods,unsigned char iLengthBits)

    732. 

  732. {

    733. 

  733. 	unsigned char iBitLast,iScan,iC;

    734. 

  734. 	for (iScan=0;iScan<iLengthBits;iScan++)

    735. 

  735. 	{

    736. 

  736. 		if (psCodeFromPeriods[11]==HID_PREAMBLE) return 1;

    737. 

  737. 		iBitLast=((psCodeFromPeriods[11]&0x80)>>7);

    738. 

  738. 		for (iC=11;iC>0;iC--)

    739. 

  739. 		{

    740. 

  740. 			psCodeFromPeriods[iC]=(psCodeFromPeriods[iC]<<1)|((psCodeFromPeriods[iC-1]>>7)&1);

    741. 

  741. 		}

    742. 

  742. 		psCodeFromPeriods[0]=(psCodeFromPeriods[0]<<1)|iBitLast;		

    743. 

  743. 	}

    744. 

  744. 	return 0;

    745. 

  745. }

    746. 

  746. /*

    747. 

  747.  ????????????? ?????????? ?? ?????????????????? ?????????

    748. 

  748.  ???	01 = 0

    749. 

  749. 		10 = 1

    750. 

  750. 		??????? ???????? ????????? ?? ?????? ????????? unsigned char

    751. 

  751. 	? ????????? ??? ?????????????? ?????? ??? ???? ? ??

    752. 

  752. 	TODO ????? ??????? ???????????? ??? ??? ?????????? ???? ?? ????? ? ????? ????????? ???????? ? ???????????? ????????????

    753. 

  753. 	? ?????????? ????? ?????????? ?? ???? ???????

    754. 

  754. 

    755. 

  755. unsigned char * decode_manchester(unsigned char *psCodeFromPeriods )

    756. 

  756. {

    757. 

  757. 	static unsigned char aCodeCard[10],iPosition,iCurentBit,iShift;    // ?????????????? ?????? aCodeCard[10] ?? ?????????? ? ???????????????? ? ???????? ?????????????

    758. 

  758. 	for (unsigned char i=1;i<12;i++)						// ??????? ??????? ??????? ??? ?? ?????????

    759. 

  759. 	{

    760. 

  760. 		iPosition=(unsigned char) ((i-1)/2);

    761. 

  761. 		for (unsigned char j=1;j<5;j++)

    762. 

  762. 		{

    763. 

  763. 			iCurentBit=(psCodeFromPeriods[i]>>(2*j-1))&1;			// ?????????? ??????? ??? ??????? ? ???????? ????? 1 ????, ??? ??? ? 0 ???? ??? ???????? ??????????

    764. 

  764. 			iShift=j-1;

    765. 

  765. 			if(!(i%2)) iShift+=4; // ???????? ???? ?????????? ?????? ??????? ? ??????????????? ???????, ?? ??? ????????? ??????? ????????, ???????? ?? ???? ???? ?? ?????? ????????? ????????? ???????, ?? ???? ??????? ? 4-?? ????

    766. 

  766. 			if (iCurentBit)

    767. 

  767. 			{

    768. 

  768. 				aCodeCard[iPosition]|=(1<<iShift);

    769. 

  769. 			}

    770. 

  770. 			else

    771. 

  771. 			{

    772. 

  772. 				aCodeCard[iPosition]&=~(1<<iShift);

    773. 

  773. 			}

    774. 

  774. 		}

    775. 

  775. 	}

    776. 

  776. 	return &aCodeCard[0];

    777. 

  777. }

    778. 

  778. 

    779. 

  779. */

    780. 

  780. /*

    781. 

  781.  ????????????? ?????????? ?? ?????????????????? ????????? ? ?????????????????? ????? ? ??????????

    782. 

  782.  ???	01 = 0

    783. 

  783. 		10 = 1

    784. 

  784. 

    785. 

  785. 		??????? ???????? ????????? ?? ?????? ????????? unsigned char ? ?????? ???????

    786. 

  786. 

    787. 

  787. ?????? ???????: ?????????????

    788. 

  788. ???????? ??: LPC1114 PIC18F14K50

    789. 

  789.  */

    790. 

  790. unsigned char * decode_manchester2bits(unsigned char *pcManchesterBits, unsigned char iSize )

    791. 

  791. {

    792. 

  792. 	unsigned char i,j,iNumberEl,iBitNextVerify=0,iCurentBit=0;

    793. 

  793. 	static unsigned char aCodeBits[14],iShift;	// static ?? ??????? decode_manchester2bits

    794. 

  794. 	for (i=0;i<iSize;i++)

    795. 

  795. 	{

    796. 

  796. 		iNumberEl=i>>1;

    797. 

  797. 		for (j=1;j<5;j++)

    798. 

  798. 		{

    799. 

  799. 			iCurentBit	=(pcManchesterBits[i]>>((j<<1)-1))&1;			// ?????????? ??????? ??? ??????? ? ???????? ????? 1 ????, ??? ??? ? 0 ???? ??? ???????? ??????????

    800. 

  800. 			//iBitNextVerify	=(pcManchesterBits[i]>>(j-1))&1;

    801. 

  801. 			//if (iCurentBit==iBitNextVerify) return 0;	// ????????? ??? ??? ???????? ???? ?? ??????????? ????? ??? ?? ?????????

    802. 

  802. 			iShift=j-1;

    803. 

  803. 			if (i&1)	{ iShift+=4; }// ???????? ???? ?????????? ?????? ??????? ? ??????????????? ???????, ?? ??? ????????? ??????? ????????, ???????? ?? ???? ???? ?? ?????? ????????? ????????? ???????, ?? ???? ??????? ? 4-?? ????

    804. 

  804. 			if (iCurentBit)

    805. 

  805. 			{

    806. 

  806. 				aCodeBits[iNumberEl]|=(1<<iShift); // TODO ??????? ????????? static ??? ???? ?????????

    807. 

  807. 			}

    808. 

  808. 			else

    809. 

  809. 			{

    810. 

  810. 				aCodeBits[iNumberEl]&=~(1<<iShift);

    811. 

  811. 			}

    812. 

  812. 		}

    813. 

  813. 	}

    814. 

  814. 	return &aCodeBits[0];

    815. 

  815. }

    816. 

  816. 

    817. 

  817. /*

    818. 

  818.  ????????????? ?????????? ?? ?????????????????? ????????? ? ?????????????????? ????? ? ??????????

    819. 

  819.  ???	01 = 0

    820. 

  820. 		10 = 1

    821. 

  821. 

    822. 

  822. 		??????? ???????? ????????? ?? ?????? ????????? unsigned char ? ?????? ???????

    823. 

  823. 

    824. 

  824. ?????? ???????: ?????????????

    825. 

  825. ???????? ??: LPC1114 PIC18F14K50

    826. 

  826.  */

    827. 

  827. unsigned char decode_manchester2bits2(unsigned char *pcManchesterBits,unsigned char *pcBitsOut, unsigned char iSize )

    828. 

  828. {

    829. 

  829. 	unsigned char i,j,iNumberEl,iCurentBit=0,iBitNextVerify=0,iShift=0;

    830. 

  830. 	for (i=0;i<iSize;i++)

    831. 

  831. 	{

    832. 

  832. 		iNumberEl=i>>1;

    833. 

  833. 		for (j=1;j<5;j++)

    834. 

  834. 		{

    835. 

  835. 			iCurentBit=(pcManchesterBits[i]>>((j<<1)-1))&1;			// ?????????? ??????? ??? ??????? ? ???????? ????? 1 ????, ??? ??? ? 0 ???? ??? ???????? ??????????

    836. 

  836. 			//iBitNextVerify	=(pcManchesterBits[i]>>(j-1))&1;

    837. 

  837. 			//if (iCurentBit==iBitNextVerify) return 0;	// ????????? ??? ??? ???????? ???? ?? ??????????? ????? ??? ?? ?????????

    838. 

  838. 			iShift=j-1;

    839. 

  839. 			if(i&1)	{ iShift+=4; }// ???????? ???? ?????????? ?????? ??????? ? ??????????????? ???????, ?? ??? ????????? ??????? ????????, ???????? ?? ???? ???? ?? ?????? ????????? ????????? ???????, ?? ???? ??????? ? 4-?? ????

    840. 

  840. 			if (iCurentBit)

    841. 

  841. 			{

    842. 

  842. 				pcBitsOut[iNumberEl]|=(1<<iShift); // TODO ??????? ????????? static ??? ???? ?????????

    843. 

  843. 			}

    844. 

  844. 			else

    845. 

  845. 			{

    846. 

  846. 				pcBitsOut[iNumberEl]&=~(1<<iShift);

    847. 

  847. 			}

    848. 

  848. 		}

    849. 

  849. 	}

    850. 

  850. 	return STATE_RESULT1;

    851. 

  851. }

    852. 

  852. 

    853. 

  853. /*

    854. 

  854.  ????? ????????? ? ???? ?????

    855. 

  855.  ??????? ?? ??? ??? ???? ?? ?????? 9 ??????,

    856. 

  856.  ??????? ???????? ??????? ?????????????????? ? ??????? 64 ???? ( unsigned long long )

    857. 

  857.  ???????? ????????

    858. 

  858.  ???? 9 ?????? ??????? - ??????? ?????????????????? ? ?????? ??????? ???? 9 ??????

    859. 

  859.  ???? 9 ?????? ?? ??????? - 0

    860. 

  860. 

    861. 

  861. unsigned long long search_header(unsigned long long  llCodeBits)

    862. 

  862. {

    863. 

  863. 	for (int i=0;i<64;i++)

    864. 

  864. 	{

    865. 

  865. 		if ((0xFF80000000000000ULL&llCodeBits)==0xFF80000000000000ULL) return llCodeBits;

    866. 

  866. 		llCodeBits=(llCodeBits<<1)|(llCodeBits>>63);

    867. 

  867. 	}

    868. 

  868. 	return 0;

    869. 

  869. }

    870. 

  870.  */

    871. 

  871. /*

    872. 

  872. 	??????? ??? ?????? ????????? ?? ???? ???? 0000111

    873. 

  873. 	??????????? ????? ?????

    874. 

  874. 	TODO ?????? ????? ??? ??????? ? ?????????? ????? ???????

    875. 

  875. 

    876. 

  876. 

    877. 

  877. unsigned char search_header_fm(unsigned char *psCodeFromPeriods)

    878. 

  878. {

    879. 

  879. 	static unsigned char iBitLast;

    880. 

  880. 	for (int iScan=0;iScan<96;iScan++)

    881. 

  881. 	{

    882. 

  882. 		iBitLast=((psCodeFromPeriods[12]&0x80)>>7);

    883. 

  883. 		for (int i=12;i>1;i--)

    884. 

  884. 		{

    885. 

  885. 			psCodeFromPeriods[i]=(psCodeFromPeriods[i]<<1)|((psCodeFromPeriods[i-1]>>7)&1);

    886. 

  886. 		}

    887. 

  887. 		psCodeFromPeriods[1]=(psCodeFromPeriods[1]<<1)|iBitLast;

    888. 

  888. 		if ((psCodeFromPeriods[12]&HID_PREAMBLE)==HID_PREAMBLE) return 1;

    889. 

  889. 	}

    890. 

  890. 	return 0;

    891. 

  891. }

    892. 

  892. */

    893. 

  893. /*

    894. 

  894. 	??????? ??? ?????? ?????????

    895. 

  895. 	HID ???? ? ?? ???? 0x1D

    896. 

  896. 	????? ? ??????? 48 ??? ?? ????? ??????? ?? ????????? (????? ????? ??????????)

    897. 

  897. 	?? ????????? HID_format_example.pdf ? ????? www.proxclone.com

    898. 

  898. 	TODO ??????????? ??????? ????? ????? ??? ??? wiegand 37( ???? ?? ????? 48-26+37)

    899. 

  899. 

    900. 

  900. 

    901. 

  901. unsigned char search_symbol(unsigned long long *pllCodeIn, unsigned long lSizeArrayBits,unsigned int iSizeBitsInSearchSymbol,unsigned int iSearchSymbol )

    902. 

  902. {

    903. 

  903. 	unsigned char iBitLast,iSizeBitsInLast,iSearchSymbolShift;

    904. 

  904. 	unsigned int i,j;

    905. 

  905. 	unsigned int iSizeLongArray,iNLastElement;

    906. 

  906. 	unsigned long long llMaskSymbolShift,llSymbol,*pllCode;

    907. 

  907. 	pllCode=pllCodeIn;

    908. 

  908. 	iSizeBitsInLast=(lSizeArrayBits%64);

    909. 

  909. 	if (iSizeBitsInLast>=iSizeBitsInSearchSymbol)	iSearchSymbolShift=iSizeBitsInLast		-iSizeBitsInSearchSymbol;		// TODO ????????? ???????? ??? ????????? ????????

    910. 

  910. 	else											iSearchSymbolShift=iSizeBitsInLast+64	-iSizeBitsInSearchSymbol;// ???? ???????? ???? ????? ??????? ???? ????????? ????? ? 2-? ????????? ???????

    911. 

  911. 	llMaskSymbolShift	= (unsigned long long)(0xFFFFFFFFFFFFFFFFULL<<iSearchSymbolShift);

    912. 

  912. 	llSymbol			= (unsigned long long)(iSearchSymbol		<<iSearchSymbolShift);

    913. 

  913. 	iSizeLongArray=(((unsigned int)(lSizeArrayBits>>6))+1); // ??????? ?????????? ?????????: long long ????? ?? ??? long long (64 ????) ? ?????????? 1

    914. 

  914. 	iNLastElement=iSizeLongArray-1;		// ????? ?????????? ???????? ? ???????

    915. 

  915. 	for (i=0;i<lSizeArrayBits;i++)

    916. 

  916. 	{

    917. 

  917. 		iBitLast=*pllCode&1;					//?????????? ?????? ??? ??? ??? ??? ??????? ?????? ???

    918. 

  918. 		for (j=0;j<iNLastElement;j++) *(pllCode+j)=(*(pllCode+j)>>1)|(*(pllCode+j+1)<<63);

    919. 

  919. 		*(pllCode+iNLastElement)=(*(pllCode+iNLastElement)>>1)|((unsigned long long)iBitLast<<(iSizeBitsInLast-1));

    920. 

  920. 		if ((*(pllCode+iNLastElement)&llMaskSymbolShift)==llSymbol) return 0x11;

    921. 

  921. 	}

    922. 

  922. 	return 0;

    923. 

  923. }

    924. 

  924. */

    925. 

  925. /*

    926. 

  926. 	 ??? ???????? ?????????

    927. 

  927. 

    928. 

  928. 

    929. 

  929. unsigned char verify_code_wiegand26(unsigned long lCodeWiegand )

    930. 

  930. {

    931. 

  931. 	unsigned char bitEP,bitOP,bitXOR;

    932. 

  932. 	bitEP=(lCodeWiegand>>25)&1;

    933. 

  933. 	bitOP=(lCodeWiegand&1);

    934. 

  934. 	bitXOR=0;

    935. 

  935. 	for (int i=0;i<12;i++)

    936. 

  936. 	{

    937. 

  937. 		lCodeWiegand>>=1;

    938. 

  938. 		bitXOR	^=(lCodeWiegand&1);

    939. 

  939. 	}

    940. 

  940. 	if (bitXOR==bitOP ) return 0x22;//????????? ???????

    941. 

  941. 	bitXOR=0;

    942. 

  942. 	for (int i=0;i<12;i++)

    943. 

  943. 	{

    944. 

  944. 		lCodeWiegand>>=1;

    945. 

  945. 		bitXOR	^=(lCodeWiegand&1);

    946. 

  946. 	}

    947. 

  947. 	if (bitXOR!=bitEP ) return 0x21;

    948. 

  948. 	return 0x11;

    949. 

  949. }

    950. 

  950.  */

    951. 

  951. /*

    952. 

  952. 	 ??? ???????? ?????????

    953. 

  953. 

    954. 

  954.  */

    955. 

  955. unsigned char verify_code_card_HID(unsigned long llCodeBits )

    956. 

  956. {

    957. 

  957. 	if ((verify_code_wiegand26((unsigned long) llCodeBits)&0x20)==0x20) return 0x21;

    958. 

  958. 	return 0x11;

    959. 

  959. }

    960. 

  960. 

    961. 

  961. unsigned char verify_code_wiegand26(unsigned long lCodeWiegand )

    962. 

  962. {

    963. 

  963. 	unsigned char bitEP,bitOP,bitXOR,i;

    964. 

  964. 	bitEP=(lCodeWiegand>>25)&1;

    965. 

  965. 	bitOP=(lCodeWiegand&1);

    966. 

  966. 	bitXOR=0;

    967. 

  967. 	for (i=0;i<12;i++)

    968. 

  968. 	{

    969. 

  969. 		lCodeWiegand>>=1;

    970. 

  970. 		bitXOR	^=(lCodeWiegand&1);

    971. 

  971. 	}

    972. 

  972. 	if (bitXOR==bitOP ) { return 0x22; }//????????? ???????

    973. 

  973. 	bitXOR=0;

    974. 

  974. 	for (i=0;i<12;i++)

    975. 

  975. 	{

    976. 

  976. 		lCodeWiegand>>=1;

    977. 

  977. 		bitXOR	^=(lCodeWiegand&1);

    978. 

  978. 	}

    979. 

  979. 	if (bitXOR!=bitEP ) { return 0x21; }

    980. 

  980. 	return 0x11;

    981. 

  981. }

    982. 

  982. 

    983. 

  983. 

    984. 

  984. /*

    985. 

  985. 	????????? ???????????? ????

    986. 

  986. 	??????? ???????? ???????? ???????? ?? ??????? ? ???????? ???????? ?? ????????

    987. 

  987. 	???????? ????? ????????? ????????? ? ???????????? ??? ????? ? ?? EM4100 ???????? 5

    988. 

  988. 	??????? ???????? ??????? ?????????????????? ? ??????? 64 ???? ( unsigned long long )

    989. 

  989. 	???????? ???????? ??? ??????

    990. 

  990. 	0 ?????? ???

    991. 

  991. 	1 ?????? ???????? ??????

    992. 

  992. 	2 ?????? ???????? ???????

    993. 

  993. 	TODO ????? ???????? ?????? ???????? ???? ??????? ? ?????? ????

    994. 

  994. 

    995. 

  995. unsigned char verify_code_card(unsigned long long  llCodeBits)

    996. 

  996. {

    997. 

  997. 	unsigned char aLine[15];

    998. 

  998. 	unsigned char iXor,i,j;

    999. 

  999. 	unsigned long long  llCodeShiftBits;

    1000. 

  1000. 	llCodeShiftBits=llCodeBits;

    1001. 

  1001. 	aLine[0]=(unsigned char)(llCodeBits&0x1F);

    1002. 

  1002. 	for (i=1;i<11; i++)

    1003. 

  1003. 	{

    1004. 

  1004. 		llCodeShiftBits=(llCodeShiftBits>>5);

    1005. 

  1005. 		aLine[i]=(unsigned char)(llCodeShiftBits&0x1F);

    1006. 

  1006. 		if (calculate_parity_line(aLine[i])) return 1; // ?????????? ??????

    1007. 

  1007. 	}

    1008. 

  1008. 	for (j=1;j<5;j++)

    1009. 

  1009. 	{

    1010. 

  1010. 		iXor=0;

    1011. 

  1011. 		for (i=1;i<11; i++)

    1012. 

  1012. 		{

    1013. 

  1013. 			iXor=iXor^((aLine[i]>>j)&1);

    1014. 

  1014. 		}

    1015. 

  1015. 		if (iXor!=((aLine[0]>>j)&1)) return 2; // ?????????? ??????

    1016. 

  1016. 	}

    1017. 

  1017. 	return 0;

    1018. 

  1018. }

    1019. 

  1019.  */

    1020. 

  1020. /*

    1021. 

  1021. 	 ???? ????????? ?????? ???????? ?? ?????????? 1

    1022. 

  1022. 

    1023. 

  1023. 

    1024. 

  1024. unsigned char calculate_parity_line(unsigned char iLine)

    1025. 

  1025. {

    1026. 

  1026. 	unsigned char iLineReal=0,iBitParity=0;

    1027. 

  1027. 	iBitParity=iLine&1;

    1028. 

  1028. 	for (int i=0;i<5; i++)

    1029. 

  1029. 	{

    1030. 

  1030. 		iLine=(iLine>>1);

    1031. 

  1031. 		iLineReal=iLineReal^(iLine&1);

    1032. 

  1032. 	}

    1033. 

  1033. 	if (iLineReal==iBitParity) return 0;

    1034. 

  1034. 	else return 1;

    1035. 

  1035. }

    1036. 

  1036.  */

    1037. 

  1037. /*

    1038. 

  1038. unsigned char calculate_parity_line(unsigned char iLine)

    1039. 

  1039. {

    1040. 

  1040. 	unsigned char iLineReal;

    1041. 

  1041. 	unsigned char aCodeCard[4];

    1042. 

  1042. 	iBitParity=aLine&1;

    1043. 

  1043. 	for (int i=0;i<5; i++)

    1044. 

  1044. 	{

    1045. 

  1045. 		iLineReal=iLineReal^((iLine>>1)&1);

    1046. 

  1046. 		aLine[i]=(llCodeBits>>10);

    1047. 

  1047. 		aLine[i]=(unsigned char)(llCodeBits&0x1F);

    1048. 

  1048. 	}

    1049. 

  1049. 	for (int i=0;i<4; i++)

    1050. 

  1050. 	{

    1051. 

  1051. 		aCodeCard[i]=(llCodeBits&0xF)|((llCodeBits>>1)&0xF0);

    1052. 

  1052. 		llCodeBits=llCodeBits>>10;

    1053. 

  1053. 	}

    1054. 

  1054. 	return ;

    1055. 

  1055. }*/

    1056. 

  1056. /*

    1057. 

  1057. 	?????????? ???? ????? ?? ??????? ??????????????????

    1058. 

  1058. 	??????? ???????? ??? ????? ? ??????? 64 ???? ( unsigned long long )

    1059. 

  1059. 

    1060. 

  1060. unsigned char *extract_code_card(unsigned long long  llCodeBits)

    1061. 

  1061. {

    1062. 

  1062. 	static unsigned char aCodeCard[]={0,0,0,0,0,0,0,0};

    1063. 

  1063. 	llCodeBits=(llCodeBits>>6);

    1064. 

  1064. 	for (int i=0;i<5; i++)

    1065. 

  1065. 	{

    1066. 

  1066. 		aCodeCard[i]=(llCodeBits&0x0F)|((llCodeBits>>1)&0xF0);

    1067. 

  1067. 		llCodeBits=llCodeBits>>10;

    1068. 

  1068. 	}

    1069. 

  1069. 	return &aCodeCard[0];

    1070. 

  1070. }

    1071. 

  1071. */

    1072. 

  1072. unsigned char *extract_code_card_HID(unsigned long lCodeBits)

    1073. 

  1073. {

    1074. 

  1074. 	unsigned char i;

    1075. 

  1075. 	static unsigned char aCodeCard[4];

    1076. 

  1076. 	lCodeBits=(lCodeBits>>1);

    1077. 

  1077. 	for (i=0;i<3;i++)

    1078. 

  1078. 	{

    1079. 

  1079. 		aCodeCard[i]=(unsigned char) (lCodeBits&0xFF);

    1080. 

  1080. 		lCodeBits>>=8;

    1081. 

  1081. 	}

    1082. 

  1082. 	aCodeCard[3]=0;

    1083. 

  1083. 	return &aCodeCard[0];

    1084. 

  1084. }
    1085.