实现赋码仪命令

升级小板程序失败时停止
2023-12-21 18:51:58 +08:00
parent af964ad733
commit d1e617afd3
22 changed files with 1291 additions and 43 deletions
--- a/elec/JQ_PSDGenerate.cpp
+++ b/elec/JQ_PSDGenerate.cpp
@@ -0,0 +1,86 @@
+#include "JQ_PSDGenerate.h"
+
+/********************************************************************************************************************
+ *                                  新版密码支持BCD码                                                               *
+********************************************************************************************************************/
+static uint32_t GetSpecialCodeIndex(uint8_t ucSpecialCode)
+{
+	if (ucSpecialCode >= '0' && ucSpecialCode <= '9')
+	{
+			return ucSpecialCode - 0x30;
+	}
+	else if (ucSpecialCode >= 'A' && ucSpecialCode <= 'Z')
+	{
+			return ucSpecialCode - 'A' + 10;
+	}
+	else if (ucSpecialCode >= 'a' && ucSpecialCode <= 'z')
+	{
+			return ucSpecialCode - 'a' + 36;
+	}
+	else
+			return 63;
+}
+
+static uint32_t GetiDateInfo(uint8_t *ucpDate)
+{
+    uint8_t ucMonth = ucpDate[0]*10 + ucpDate[1];
+    uint8_t ucDay = ucpDate[2]*10 + ucpDate[3];
+	
+	return ucMonth << 5 | ucDay;
+}
+
+//public static string GetPasswordByShellCode(string shellcode)
+//{
+//		string ssp = shellcode.Substring(7, 1);
+//		string sdate = shellcode.Substring(3, 4);
+//		string sindex = shellcode.Substring(8, 5); 
+
+//		UInt32 u32BCD = (UInt32)(((GetiDateInfo(sdate) & 0x1FF) << 23) |
+//										 ((GetSpecialCodeIndex(ssp) & 0x3F) << 17) |
+//										 (GetiIndex(sindex) & 0x1FFFF));
+
+//		return U32tohexstr(u32BCD);
+
+//}
+
+uint8_t JQ_GetPasswordByUidCode(const uint8_t *uidcode,uint8_t* psd)
+{
+    uint8_t  ucSpecialCode = 0;
+    uint8_t usaDate[4] = {0};
+    uint32_t ulIndex = 0;
+    uint32_t ulBCDPsd = 0;
+    uint8_t  i=0;
+
+	
+	//581900230A12345
+	ucSpecialCode = uidcode[9];
+	for(i=5;i<9;i++)
+		usaDate[i-5] = uidcode[i]-0x30;
+	
+	for(i=10;i<15;i++)
+	{
+		ulIndex *= 10;
+		ulIndex += (uidcode[i]-0x30);
+	} 
+	
+	ulBCDPsd = (GetiDateInfo(usaDate) & 0x1FF) << 23 |
+						 (GetSpecialCodeIndex(ucSpecialCode) & 0x3F) << 17 |
+							ulIndex & 0x1FFFF;
+	
+//	psd[0] = (ulBCDPsd&0xFF000000)>>24;
+//	psd[1] = (ulBCDPsd&0x00FF0000)>>16;
+//	psd[2] = (ulBCDPsd&0x0000FF00)>>8;
+//	psd[3] =  ulBCDPsd&0x000000FF;
+	// 反序
+	psd[3] = (ulBCDPsd&0xFF000000)>>24;
+	psd[2] = (ulBCDPsd&0x00FF0000)>>16;
+	psd[1] = (ulBCDPsd&0x0000FF00)>>8;
+	psd[0] =  ulBCDPsd&0x000000FF;
+	return 0;
+}
+
+
+
+
+
+