SM2.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128
  1. /*************************************************************************
  2. * 版权所有:
  3. * 文件版本: V1.00
  4. * 文件名称:SM2.c
  5. * 生成日期: 2012年7月1日
  6. * 作 者: xxxxxx
  7. * 功 能: 事件记录处理
  8. * 更新信息:
  9. * 更新日志1:
  10. * 日期:
  11. * 修改者:
  12. * 修改内容:
  13. * 修改原因:
  14. *
  15. **************************************************************************/
  16. #include "head.h"
  17. #ifdef ENCRYPT_SM2
  18. char sm2debugstr[256];
  19. #if 1 // 长沙,测试104
  20. unsigned char SM2_key1[68]=
  21. {
  22. 0x00,0x01,0x00,0x00,0xB8,0x22,0x88,0x73,0xB8,0x0D,0xE8,0xD8,0x5E,0xDF,0x12,0xB8,
  23. 0x27,0xDD,0x71,0x8A,0x7D,0xF6,0x38,0x22,0xDB,0x79,0x3D,0x42,0x9B,0x20,0xE8,0x3F,
  24. 0x74,0x70,0x22,0x97,0x3E,0x1F,0x19,0x6E,0x41,0x81,0xC7,0x9F,0xA5,0x8D,0xB7,0x89,
  25. 0x8F,0xF9,0x3E,0xC4,0x4B,0x6C,0xAE,0xB1,0xC9,0x8C,0x3B,0xDC,0x53,0xA2,0x78,0xAA,
  26. 0x8D,0x77,0x4E,0x2A
  27. };
  28. unsigned char SM2_key2[68]=
  29. {
  30. 0x00,0x01,0x00,0x00,0xBF,0xE3,0xC3,0x5B,0xE1,0x1A,0x18,0x0F,0x65,0x43,0x16,0x9D,
  31. 0x0C,0x82,0x6B,0xBF,0x38,0xDA,0xB7,0x2E,0x0E,0x4E,0x01,0x26,0x9C,0x4A,0xE8,0xAB,
  32. 0x16,0xAD,0xEA,0xEC,0x15,0x84,0xA3,0x45,0x7C,0xAE,0xE5,0x8A,0xF1,0x0F,0x9A,0x1E,
  33. 0x17,0x92,0x75,0x94,0xA4,0x72,0x53,0x37,0xFA,0xE9,0xAC,0x3C,0x8D,0xA1,0x64,0xF9,
  34. 0xE1,0x57,0x37,0x28
  35. };
  36. #endif
  37. #if 0 // 电科院,测试101
  38. unsigned char SM2_key1[68]=
  39. {
  40. 0x00,0x00,0x01,0x00,0xe4,0x00,0xaa,0xef,0xdc,0xf9,0x40,0x84,0x1a,0x24,0x27,0xe0,
  41. 0x9a,0x59,0xeb,0x6d,0x93,0xdb,0x97,0x41,0xbf,0xf3,0x72,0xa0,0x19,0xe8,0xf0,0x04,
  42. 0x80,0xab,0xb5,0xd9,0x27,0x8e,0xde,0x11,0x35,0x1e,0xf3,0xde,0x86,0x25,0x2d,0x60,
  43. 0xe2,0xef,0x90,0xfe,0x57,0xe7,0x98,0x1a,0x60,0xc0,0xad,0xac,0xce,0x2f,0x35,0x05,
  44. 0xeb,0xfc,0xf1,0xd5
  45. };
  46. unsigned char SM2_key2[68]=
  47. {
  48. 0x00,0x00,0x01,0x00,0x9c,0x5b,0x8d,0x20,0xe6,0xd8,0x51,0x1b,0x27,0x7b,0x81,0x77,
  49. 0xc3,0x5b,0x9f,0xd9,0x87,0x11,0x09,0xe8,0xa9,0x96,0x57,0x83,0x41,0xa9,0x29,0x48,
  50. 0xb3,0xd3,0x58,0xb5,0x63,0x54,0xa9,0xbf,0xdd,0xfd,0x4a,0x71,0xa8,0xb9,0x4a,0x68,
  51. 0x8d,0xa7,0x64,0x77,0xa5,0xcc,0x74,0x69,0x87,0x8c,0x7a,0xd7,0x49,0x71,0x60,0xbe,
  52. 0xb7,0x5a,0x26,0xe6
  53. };
  54. #endif
  55. #if 0 // 珠海许继
  56. unsigned char SM2_key1[68]=
  57. {
  58. 0x00,0x01,0x00,0x00,0x7D,0xCF,0x5D,0xAD,0xBB,0xB3,0x21,0xD7,0xDA,0xCF,0x82,0x83,
  59. 0x6C,0xAE,0x43,0xD4,0x69,0x60,0xFC,0xA4,0xDB,0xBA,0x58,0xD9,0xB1,0x07,0x45,0xD0,
  60. 0x89,0x73,0x98,0x2A,0x60,0x5C,0x93,0x93,0x24,0x68,0x28,0x55,0xA2,0xE2,0xB7,0xDD,
  61. 0x1A,0x58,0xEC,0x7E,0x8E,0x08,0x16,0x1C,0xA5,0xFC,0x69,0x92,0x9E,0x2F,0x1F,0x0D,
  62. 0x83,0x71,0x03,0xA0
  63. };
  64. unsigned char SM2_key2[68]=
  65. {
  66. 0x00,0x01,0x00,0x00,0x28,0x1A,0x0B,0x17,0x77,0xE0,0x46,0x2D,0x1E,0x5E,0x1C,0x85,
  67. 0x0C,0x49,0xA2,0xE7,0x17,0x3F,0xDF,0xA7,0xC2,0x09,0xB0,0x21,0xE1,0x0E,0xB9,0xD0,
  68. 0x62,0x72,0x90,0x85,0x5D,0x2C,0x41,0x50,0x7C,0x30,0x29,0xEF,0xCD,0x98,0x73,0x33,
  69. 0xB3,0x3A,0x77,0xD7,0x9C,0xD6,0xDC,0x20,0xDC,0xA8,0x6E,0x1F,0x93,0x75,0x1F,0xE6,
  70. 0xB7,0x33,0x69,0x42
  71. };
  72. #endif
  73. unsigned char SM2_key3[68]=
  74. {
  75. 0x00,0x00,0x01,0x00,0x7c,0x33,0x14,0x18,0x02,0xb3,0x7d,0x02,0x17,0xd9,0xef,0xe7,
  76. 0xf3,0x1b,0xb3,0xb6,0x86,0x4a,0x76,0x05,0xf5,0xca,0x43,0x72,0x5d,0xa5,0x79,0xe2,
  77. 0xef,0xe3,0x1e,0xbb,0x82,0x82,0x20,0x04,0x5f,0x62,0x48,0xb9,0xfd,0xda,0x83,0xda,
  78. 0xb9,0x69,0x0e,0x89,0x15,0xef,0x55,0xed,0x02,0xe9,0x6e,0x87,0x05,0xc2,0x22,0x5f,
  79. 0x7b,0xfc,0xf0,0xec
  80. };
  81. unsigned char SM2_key4[68]=
  82. {
  83. 0x00,0x00,0x01,0x00,0x19,0xdc,0x29,0xd8,0x1a,0x2b,0x28,0x7d,0x3e,0x93,0xdf,0x22,
  84. 0xe0,0x70,0xdd,0x9b,0x23,0x63,0x11,0x6b,0x51,0x97,0xb1,0xec,0x74,0xb5,0x17,0xe2,
  85. 0x41,0xd4,0x53,0x8b,0x72,0x4b,0x64,0x3b,0x6c,0x31,0x4f,0x77,0xab,0x93,0xf3,0xfb,
  86. 0x9b,0x21,0x46,0x29,0xc2,0x80,0xae,0x49,0xdf,0xe8,0x43,0x9e,0xef,0x61,0xd2,0x42,
  87. 0xf2,0x02,0x2e,0x90
  88. };
  89. unsigned char UserId[16]=
  90. {
  91. //0x8F,0x12,0xE1,0x63,0xD2,0xAF,0x1C,0xAD,0x7C,0x58,0xE7,0xF4,0x65,0x0D,0x9B,0x4E
  92. 0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01
  93. };
  94. int readSM2key(BYTE no,BYTE *dat)
  95. {
  96. BYTE sm2file[32];
  97. loff_t pos;
  98. struct file * gfile;
  99. memset(dat,0,68);
  100. if(no>4)return -1; //key 最多支持5个
  101. sprintf(sm2file,"/app/data/sm2key%1d.bin",no);
  102. gfile = rt_file_open(sm2file,O_RDONLY,0);
  103. if(IS_ERR(gfile))
  104. {
  105. return -2;
  106. }
  107. pos = 0;
  108. rt_file_read(gfile,dat,68,&pos);
  109. rt_file_close(gfile,NULL);
  110. return 0;
  111. }
  112. int writeSM2key(BYTE no,BYTE *dat)
  113. {
  114. BYTE sm2file[32];
  115. loff_t pos;
  116. struct file * gfile;
  117. if(no>4)return -1; //key 最多支持5个
  118. sprintf(sm2file,"/app/data/sm2key%1d.bin",no);
  119. gfile = rt_file_open(sm2file,O_CREAT|O_RDWR|O_TRUNC,0);
  120. if(IS_ERR(gfile))
  121. {
  122. return -2;
  123. }
  124. pos = 0;
  125. rt_file_write(gfile,dat,68,&pos);
  126. rt_file_close(gfile,NULL);
  127. return 0;
  128. }
  129. int readUserId(BYTE *dat)
  130. {
  131. loff_t pos;
  132. struct file * gfile;
  133. gfile = rt_file_open("/app/data/userid.bin",O_RDONLY,0);
  134. memset(dat,0,16);
  135. if(IS_ERR(gfile))
  136. {
  137. return -1;
  138. }
  139. pos = 0;
  140. rt_file_read(gfile,dat,16,&pos);
  141. rt_file_close(gfile,NULL);
  142. return 0;
  143. }
  144. int writeUserId(BYTE *dat)
  145. {
  146. loff_t pos;
  147. struct file * gfile;
  148. gfile = rt_file_open("/app/data/userid.bin",O_CREAT|O_RDWR|O_TRUNC,0);
  149. if(IS_ERR(gfile))
  150. {
  151. return -1;
  152. }
  153. pos = 0;
  154. rt_file_write(gfile,dat,16,&pos);
  155. rt_file_close(gfile,NULL);
  156. return 0;
  157. }
  158. void InitSM2Key(void)
  159. {
  160. writeSM2key(0,SM2_key1);
  161. writeSM2key(1,SM2_key2);
  162. writeSM2key(2,SM2_key3);
  163. writeSM2key(3,SM2_key4);
  164. writeUserId(UserId);
  165. }
  166. #if 0 // 此函数对1月解码有问题,不能使用
  167. static uint32_t mktime_me(TIME *ct)
  168. {
  169. TIME Tm;
  170. WORD Year;
  171. Tm=*ct;
  172. Year = Tm.year+2000;
  173. if (0 >= (int) (Tm.month -= 2)) { /* 1..12 -> 11,12,1..10 */
  174. Tm.month += 12; /* Puts Feb last since it has leap day */
  175. Year -= 1;
  176. }
  177. return (((
  178. (uint32_t) (Year/4 - Year/100 + Year/400 + 367*Tm.month/12 + Tm.day) +
  179. Year*365 - 719499
  180. )*24 + Tm.hour /* now have hours */
  181. )*60 + Tm.min /* now have minutes */
  182. )*60 + (Tm.ms/1000); /* finally seconds */
  183. }
  184. #endif
  185. ECCrefPublicKey *PubKeyNk;
  186. ECCCipher EccMessage;
  187. static void IEC101_SM2Echo(IEC101_DEF *pt,BYTE *dat) // 报文应答cf=3 cf=4
  188. {
  189. BYTE *txbuf=pt->tx_buf_s;
  190. BYTE *pd=&txbuf[1];
  191. DWORD ltime;
  192. unsigned int outlen;
  193. BYTE keystr[68]; //
  194. BYTE datIn[32],pucrandom[32]; //
  195. BYTE sum=0;
  196. BYTE L2;
  197. int i;
  198. BYTE keynew;
  199. uint32_t us0,us;
  200. struct timespec ts;
  201. // struct rtc_time_t rtc;
  202. clk_time_get(&ts);
  203. // timespec_to_rtc(ts,&rtc,1);
  204. keynew=(dat[1]&0x03); //加密或更新的证书
  205. L2=142;
  206. *pd++=0x16;
  207. *pd++=L2;
  208. *pd++=0x00;
  209. *pd++=0x16;
  210. *pd++=dat[0]; //功能码
  211. *pd++=dat[1]; //辅助状态
  212. *pd++=(BYTE)tRunPara.byAddr; //装置地址 4字节
  213. *pd++=(BYTE)(tRunPara.byAddr>>8);
  214. *pd++=0;
  215. *pd++=0;
  216. // ltime=mktime_me(&rtc)-28800; //北京东8区,减去8*3600秒
  217. ltime=ts.tv_sec-28800; //北京东8区,减去8*3600秒
  218. // ltime=0xDF987C4E; //时间戳 测试用
  219. *pd++=(BYTE)ltime; //时间戳
  220. *pd++=(BYTE)(ltime>>8);
  221. *pd++=(BYTE)(ltime>>16);
  222. *pd++=(BYTE)(ltime>>24);
  223. *pd++=1; //公钥个数
  224. *pd++=0x00;
  225. *pd++=0x00;
  226. *pd++=0x00;
  227. memset(datIn,0,32);
  228. for(i=0;i<4;i++)
  229. {
  230. datIn[i]=dat[10+i]; //接收到的数据(4字节)
  231. }
  232. SM2_GenerateRandom_me(32, pucrandom); //随机变量
  233. readSM2key(keynew, keystr); //key值
  234. us0 = ustimer_get_origin();
  235. SM2_Encrypt(datIn, 32, (ECCrefPublicKey*)keystr, pucrandom, 32, &EccMessage); //非对称加密报文128个字节
  236. us = ustimer_get_duration(us0);
  237. if(g_print_sys)
  238. {
  239. sprintf(sm2debugstr,"SM2_Encrypt程序运行时间:%dus.\r\n",us);
  240. rt_printf(sm2debugstr);
  241. }
  242. memcpy(pd, EccMessage.x, 128); // 非对称加密报文
  243. pd=&txbuf[5]; // 从功能码开始计算校验和
  244. for(i = 0; i < L2; i++) // L2=0x8e 142个字节
  245. {
  246. sum += pd[i];
  247. }
  248. for(i = 0; i < 14; i++) //
  249. {
  250. datIn[i]= pd[i]; // 安全数据区数据,用做加密的输入数据
  251. }
  252. encrypt_epri(datIn, 14, pd, &outlen, (sum|0xffffff00), (sum%3)); //报文对称加密,输出加密报文到发送缓冲区
  253. pd=&txbuf[L2+5]; //校验和位置
  254. *pd++=sum;
  255. *pd++=0x16;
  256. txbuf[0]=L2+6; //发送字节数
  257. if(g_print_101 && (g_print_port & (1<<pt->chnl)))
  258. {
  259. rt_printf("上送加密报文:");
  260. print_msg("TX_101:",&txbuf[1],txbuf[0]);
  261. }
  262. pt->btx_buf_s = true;
  263. }
  264. BYTE sm2dat[160];
  265. BYTE sm2Verifydat[256];
  266. void IEC101_SM2(IEC101_DEF* pt)
  267. {
  268. BYTE *pd=&pt->recvbuf[256];
  269. BYTE *pv=sm2Verifydat;
  270. BYTE byL2,byL3,bySum;
  271. BYTE sum;
  272. DWORD sm2Addr,sm2Time,localTime,offTime;
  273. unsigned int lenth;
  274. int i;
  275. uint32_t us0,us;
  276. byL2=pd[1];
  277. byL3=pd[2];
  278. bySum=pd[byL2+4]; //校验和
  279. if(g_print_101 && (g_print_port & (1<<pt->chnl)))
  280. {
  281. print_msg("SM_101:",pd,byL2+6);
  282. }
  283. if(g_print_sys)
  284. {
  285. sprintf(sm2debugstr,"L2=%02x L3=%02x bysum=%02x \r\n",byL2,byL3,bySum);
  286. rt_printf(sm2debugstr);
  287. }
  288. us0 = ustimer_get_origin();
  289. encrypt_epri(&pd[4], (byL2-byL3), sm2dat,&lenth,(bySum|0xffffff00),(bySum%3)); //解密安全数据区
  290. us = ustimer_get_duration(us0);
  291. if(g_print_sys)
  292. {
  293. sprintf(sm2debugstr,"程序运行时间:%dus.\r\n对称加密解密报文:",us);
  294. rt_printf(sm2debugstr);
  295. print_mem_net(NULL,sm2dat,byL2-byL3);
  296. }
  297. //校验和
  298. sum=0;
  299. for(i=0;i<(byL2-byL3);i++)
  300. {
  301. sum+=sm2dat[i];
  302. }
  303. for(i=0;i<byL3;i++)
  304. {
  305. sum+=pd[(byL2-byL3)+4+i];
  306. }
  307. if(g_print_sys)
  308. {
  309. sprintf(sm2debugstr,"\r\n校验和:sum=%02x bySum=%02x\r\n",sum,bySum);
  310. rt_printf(sm2debugstr);
  311. }
  312. if(sum!=bySum)
  313. {
  314. return; //校验和不相等
  315. }
  316. sm2Addr=sm2dat[2]+(sm2dat[3]<<8)+(sm2dat[4]<<16)+(sm2dat[5]<<24); //装置地址
  317. if(g_print_sys)
  318. {
  319. sprintf(sm2debugstr,"\r\n地址:sm2Addr=%d byAddr=%d\r\n",sm2Addr,tRunPara.byAddr);
  320. rt_printf(sm2debugstr);
  321. }
  322. if((tRunPara.byAddr!=(WORD)sm2Addr)&&(sm2Addr!=0xffffffff))
  323. {
  324. return; //不是发给本装置的数据
  325. }
  326. sm2Time=sm2dat[6]+(sm2dat[7]<<8)+(sm2dat[8]<<16)+(sm2dat[9]<<24); // 时间戳
  327. {
  328. struct timespec ts;
  329. // struct rtc_time_t rtc;
  330. clk_time_get(&ts);
  331. // timespec_to_rtc(ts,&rtc,1);
  332. // localTime=mktime_me(&rtc)-28800; //北京东8区,减去8*3600秒
  333. localTime=ts.tv_sec-28800; //北京东8区,减去8*3600秒
  334. }
  335. if(g_print_sys)
  336. {
  337. sprintf(sm2debugstr,"\r\n时间戳sm2=%d local=%d\r\n",sm2Time,localTime);
  338. rt_printf(sm2debugstr);
  339. }
  340. // 证书有效时间判定
  341. {
  342. u8 no;
  343. no = (sm2dat[0]&0x03); //公钥号
  344. if (x509_isvalid_time(no, localTime) != 0)
  345. {
  346. return;
  347. }
  348. }
  349. if(sm2Time>localTime)
  350. {
  351. offTime=sm2Time-localTime;
  352. }
  353. else
  354. {
  355. offTime=localTime-sm2Time;
  356. }
  357. if(offTime>tRunPara.dSM2Time) //时间戳超时
  358. {
  359. if(g_print_sys)
  360. {
  361. rt_printf("时间戳无效\r\n");
  362. }
  363. return;
  364. }
  365. if((sm2dat[0]&0x40)==0) //主站下发数据
  366. {
  367. BYTE keyno,Cf,keynew;
  368. BYTE keystr[68];
  369. BYTE vlenth=0; //待鉴签数据长度包括遥控报文、安全数据头4字节 +安全数据区报文(L2-L3)
  370. int ret;
  371. BYTE pUserId[16];
  372. Cf=((sm2dat[0]>>2)&0x0f); //功能号
  373. keyno=(sm2dat[0]&0x03); //公钥号
  374. keynew=(sm2dat[1]&0x03); //加密或更新的证书
  375. if(g_print_sys)
  376. {
  377. sprintf(sm2debugstr,"\r\n功能号=%d 公钥号=%d 更新号=%d\r\n",Cf,keyno,keynew);
  378. rt_printf(sm2debugstr);
  379. }
  380. readSM2key(keyno,keystr);
  381. if(Cf==1) //遥控报文,鉴签包括遥控数据(101报文)
  382. {
  383. for(i=0;i<(pt->recvbuf[1]+6);i++)
  384. {
  385. *pv++=pt->recvbuf[i];
  386. vlenth++;
  387. }
  388. }
  389. for(i=0;i<4;i++) // 安全报文头
  390. {
  391. *pv++=pd[i];
  392. vlenth++;
  393. }
  394. for(i=0;i<(byL2-byL3);i++) // 安全数据报文
  395. {
  396. *pv++=sm2dat[i];
  397. vlenth++;
  398. }
  399. if(g_print_sys)
  400. {
  401. print_msg("对称加密报文:",sm2Verifydat,vlenth);
  402. }
  403. //rt_irq_save(flags);
  404. us0 = ustimer_get_origin();
  405. readUserId(pUserId);
  406. ret=SM2_Verify(sm2Verifydat, vlenth,pUserId,16,(ECCrefPublicKey*)keystr,(ECCSignature *)&pd[byL2-byL3+4]); //验签
  407. us = ustimer_get_duration(us0);
  408. //rt_irq_restore(flags);
  409. if(g_print_sys)
  410. {
  411. sprintf(sm2debugstr,"SM2_Verify程序运行时间:%dus.\r\n",us);
  412. rt_printf(sm2debugstr);
  413. sprintf(sm2debugstr,"SM2_Verify ret=%d\r\n",ret);
  414. rt_printf(sm2debugstr);
  415. }
  416. if(ret==0) //鉴签成功
  417. {
  418. switch(Cf)
  419. {
  420. case 1: //Cf==1 控制命令
  421. {
  422. pt->bData=true; //遥控报文验证成功,可转正常101规约数据处理
  423. if(g_print_sys)
  424. {
  425. sprintf(sm2debugstr,"SM2_Verify 成功,转遥控处理\r\n",ret);
  426. rt_printf(sm2debugstr);
  427. }
  428. break;
  429. }
  430. case 2: //Cf==2 会话密钥协商
  431. break;
  432. case 3: //Cf==3 检查公钥
  433. {
  434. IEC101_SM2Echo(pt,sm2dat);
  435. break;
  436. }
  437. case 4: //Cf==4 更新公钥
  438. {
  439. for(i=0;i<68;i++)
  440. {
  441. keystr[i]=sm2dat[14+i]; //取得新公钥
  442. }
  443. if(g_print_sys)
  444. {
  445. sprintf(sm2debugstr,"新公钥%d:",keynew);
  446. print_msg(sm2debugstr,keystr,68);
  447. }
  448. writeSM2key(keynew,keystr); //保存新公钥
  449. IEC101_SM2Echo(pt,sm2dat);
  450. break;
  451. }
  452. default:
  453. break;
  454. }
  455. }
  456. }
  457. }
  458. static void IEC104_SM2Echo(IEC104_DEF *pt,BYTE *dat) // 报文应答cf=3 cf=4
  459. {
  460. BYTE *pd=&pt->arrSendBuf[1];
  461. DWORD ltime;
  462. unsigned int outlen;
  463. BYTE keystr[68]; //
  464. BYTE datIn[32],pucrandom[32]; //
  465. BYTE sum=0;
  466. BYTE L2;
  467. int i;
  468. BYTE keynew;
  469. uint32_t us0,us;
  470. struct timespec ts;
  471. // struct rtc_time_t rtc;
  472. clk_time_get(&ts);
  473. // timespec_to_rtc(ts,&rtc,1);
  474. keynew=(dat[1]&0x03); //加密或更新的证书
  475. L2=142;
  476. *pd++=0x16;
  477. *pd++=L2;
  478. *pd++=0x00;
  479. *pd++=0x16;
  480. *pd++=dat[0]; //功能码
  481. *pd++=dat[1]; //辅助状态
  482. *pd++=(BYTE)tRunPara.byAddr; //装置地址 4字节
  483. *pd++=(BYTE)(tRunPara.byAddr>>8);
  484. *pd++=0;
  485. *pd++=0;
  486. // ltime=mktime_me(&rtc)-28800; //北京东8区,减去8*3600秒
  487. ltime=ts.tv_sec-28800; //北京东8区,减去8*3600秒
  488. // ltime=0xDF987C4E; //时间戳 测试用
  489. *pd++=(BYTE)ltime; //时间戳
  490. *pd++=(BYTE)(ltime>>8);
  491. *pd++=(BYTE)(ltime>>16);
  492. *pd++=(BYTE)(ltime>>24);
  493. *pd++=1; //公钥个数
  494. *pd++=0x00;
  495. *pd++=0x00;
  496. *pd++=0x00;
  497. memset(datIn,0,32);
  498. for(i=0;i<4;i++)
  499. {
  500. datIn[i]=dat[10+i]; //接收到的数据(4字节)
  501. }
  502. SM2_GenerateRandom_me(32, pucrandom); //随机变量
  503. readSM2key(keynew, keystr); //key值
  504. us0 = ustimer_get_origin();
  505. SM2_Encrypt(datIn, 32, (ECCrefPublicKey*)keystr, pucrandom, 32, &EccMessage); //非对称加密报文128个字节
  506. us = ustimer_get_duration(us0);
  507. if(g_print_sys)
  508. {
  509. sprintf(sm2debugstr,"SM2_Encrypt程序运行时间:%dus.\r\n",us);
  510. rt_printf(sm2debugstr);
  511. }
  512. memcpy(pd, EccMessage.x, 128); // 非对称加密报文
  513. pd=&pt->arrSendBuf[5]; // 从功能码开始计算校验和
  514. for(i = 0; i < L2; i++) // L2=0x8e 142个字节
  515. {
  516. sum += pd[i];
  517. }
  518. for(i = 0; i < 14; i++) //
  519. {
  520. datIn[i]= pd[i]; // 安全数据区数据,用做加密的输入数据
  521. }
  522. encrypt_epri(datIn, 14, pd, &outlen, (sum|0xffffff00), (sum%3)); //报文对称加密,输出加密报文到发送缓冲区
  523. pd=&pt->arrSendBuf[L2+5]; //校验和位置
  524. *pd++=sum;
  525. *pd++=0x16;
  526. pt->arrSendBuf[0]=L2+6; //发送字节数
  527. if(g_print_104 && (g_print_port & (1<<pt->chnl)))
  528. {
  529. rt_printf("上送加密报文:");
  530. print_msg("TX_104:",&pt->arrSendBuf[1],L2+6);
  531. }
  532. IEC104_SM2Send(pt);
  533. }
  534. void IEC104_SM2(IEC104_DEF* pt)
  535. {
  536. BYTE *pd=&pt->arrRecvBuf[256];
  537. BYTE *pv=sm2Verifydat;
  538. BYTE byL2,byL3,bySum;
  539. BYTE sum;
  540. DWORD sm2Addr,sm2Time,localTime,offTime;
  541. unsigned int lenth;
  542. int i;
  543. uint32_t us0,us;
  544. byL2=pd[1];
  545. byL3=pd[2];
  546. bySum=pd[byL2+4]; //校验和
  547. if(g_print_104 && (g_print_port & (1<<pt->chnl)))
  548. {
  549. print_msg("SM_104:",pd,byL2+6);
  550. }
  551. if(g_print_sys)
  552. {
  553. sprintf(sm2debugstr,"L2=%02x L3=%02x bysum=%02x \r\n",byL2,byL3,bySum);
  554. rt_printf(sm2debugstr);
  555. }
  556. us0 = ustimer_get_origin();
  557. encrypt_epri(&pd[4], (byL2-byL3), sm2dat,&lenth,(bySum|0xffffff00),(bySum%3)); //解密安全数据区
  558. us = ustimer_get_duration(us0);
  559. if(g_print_sys)
  560. {
  561. sprintf(sm2debugstr,"程序运行时间:%dus.\r\n对称加密解密报文:",us);
  562. rt_printf(sm2debugstr);
  563. print_mem_net(NULL,sm2dat,byL2-byL3);
  564. }
  565. //校验和
  566. sum=0;
  567. for(i=0;i<(byL2-byL3);i++)
  568. {
  569. sum+=sm2dat[i];
  570. }
  571. for(i=0;i<byL3;i++)
  572. {
  573. sum+=pd[(byL2-byL3)+4+i];
  574. }
  575. if(g_print_sys)
  576. {
  577. sprintf(sm2debugstr,"\r\n校验和:sum=%02x bySum=%02x\r\n",sum,bySum);
  578. rt_printf(sm2debugstr);
  579. }
  580. if(sum!=bySum)
  581. {
  582. return; //校验和不相等
  583. }
  584. sm2Addr=sm2dat[2]+(sm2dat[3]<<8)+(sm2dat[4]<<16)+(sm2dat[5]<<24); //装置地址
  585. if(g_print_sys)
  586. {
  587. sprintf(sm2debugstr,"\r\n地址:sm2Addr=%d byAddr=%d\r\n",sm2Addr,tRunPara.byAddr);
  588. rt_printf(sm2debugstr);
  589. }
  590. if((tRunPara.byAddr!=(WORD)sm2Addr)&&(sm2Addr!=0xffffffff))
  591. {
  592. return; //不是发给本装置的数据
  593. }
  594. sm2Time=sm2dat[6]+(sm2dat[7]<<8)+(sm2dat[8]<<16)+(sm2dat[9]<<24); // 时间戳
  595. {
  596. struct timespec ts;
  597. // struct rtc_time_t rtc;
  598. clk_time_get(&ts);
  599. // timespec_to_rtc(ts,&rtc,1);
  600. // localTime=mktime_me(&rtc)-28800; //北京东8区,减去8*3600秒
  601. localTime=ts.tv_sec-28800; //北京东8区,减去8*3600秒
  602. }
  603. if(g_print_sys)
  604. {
  605. struct timespec ts;
  606. sprintf(sm2debugstr,"\r\n时间戳sm2=%d local=%d\r\n",sm2Time,localTime);
  607. rt_printf(sm2debugstr);
  608. ts.tv_nsec =0;
  609. ts.tv_sec = sm2Time += 28800;
  610. rt_printf(" sm2Time:");
  611. rt_printf_time2(ts);
  612. ts.tv_sec = localTime += 28800;
  613. rt_printf("localTime:");
  614. rt_printf_time2(ts);
  615. }
  616. // 证书有效时间判定
  617. {
  618. u8 no;
  619. no = (sm2dat[0]&0x03); //公钥号
  620. if (x509_isvalid_time(no, localTime) != 0)
  621. {
  622. return;
  623. }
  624. }
  625. if(sm2Time>localTime)
  626. {
  627. offTime=sm2Time-localTime;
  628. }
  629. else
  630. {
  631. offTime=localTime-sm2Time;
  632. }
  633. if(offTime>tRunPara.dSM2Time) //时间戳超时
  634. {
  635. if(g_print_sys)
  636. {
  637. rt_printf("时间戳无效\r\n");
  638. }
  639. return;
  640. }
  641. if((sm2dat[0]&0x40)==0) //主站下发数据
  642. {
  643. BYTE keyno,Cf,keynew;
  644. BYTE keystr[68];
  645. BYTE vlenth=0; //待鉴签数据长度包括遥控报文、安全数据头4字节 +安全数据区报文(L2-L3)
  646. int ret;
  647. BYTE pUserId[16];
  648. Cf=((sm2dat[0]>>2)&0x0f); //功能号
  649. keyno=(sm2dat[0]&0x03); //公钥号
  650. keynew=(sm2dat[1]&0x03); //加密或更新的证书
  651. if(g_print_sys)
  652. {
  653. sprintf(sm2debugstr,"\r\n功能号=%d 公钥号=%d 更新号=%d\r\n",Cf,keyno,keynew);
  654. rt_printf(sm2debugstr);
  655. }
  656. readSM2key(keyno,keystr);
  657. if(Cf==1) //遥控报文,鉴签包括遥控数据(101报文)
  658. {
  659. for(i=0;i<(pt->arrRecvBuf[1]+2);i++)
  660. {
  661. *pv++=pt->arrRecvBuf[i];
  662. vlenth++;
  663. }
  664. }
  665. for(i=0;i<4;i++) // 安全报文头
  666. {
  667. *pv++=pd[i];
  668. vlenth++;
  669. }
  670. for(i=0;i<(byL2-byL3);i++) // 安全数据报文
  671. {
  672. *pv++=sm2dat[i];
  673. vlenth++;
  674. }
  675. if(g_print_sys)
  676. {
  677. print_msg("对称加密报文:",sm2Verifydat,vlenth);
  678. }
  679. //rt_irq_save(flags);
  680. us0 = ustimer_get_origin();
  681. readUserId(pUserId);
  682. ret=SM2_Verify(sm2Verifydat, vlenth,pUserId,16,(ECCrefPublicKey*)keystr,(ECCSignature *)&pd[byL2-byL3+4]); //验签
  683. us = ustimer_get_duration(us0);
  684. //rt_irq_restore(flags);
  685. if(g_print_sys)
  686. {
  687. sprintf(sm2debugstr,"SM2_Verify程序运行时间:%dus.\r\n",us);
  688. rt_printf(sm2debugstr);
  689. sprintf(sm2debugstr,"SM2_Verify ret=%d\r\n",ret);
  690. rt_printf(sm2debugstr);
  691. }
  692. if(ret==0) //鉴签成功
  693. {
  694. switch(Cf)
  695. {
  696. case 1: //Cf==1 控制命令
  697. {
  698. pt->bRecvOk=true; //遥控报文验证成功,可转正常104规约数据处理
  699. if(g_print_sys)
  700. {
  701. sprintf(sm2debugstr,"SM2_Verify 成功,转遥控处理\r\n",ret);
  702. rt_printf(sm2debugstr);
  703. }
  704. break;
  705. }
  706. case 2: //Cf==2 会话密钥协商
  707. break;
  708. case 3: //Cf==3 检查公钥
  709. {
  710. IEC104_SM2Echo(pt,sm2dat);
  711. break;
  712. }
  713. case 4: //Cf==4 更新公钥
  714. {
  715. for(i=0;i<68;i++)
  716. {
  717. keystr[i]=sm2dat[14+i]; //取得新公钥
  718. }
  719. if(g_print_sys)
  720. {
  721. sprintf(sm2debugstr,"新公钥%d:",keynew);
  722. print_msg(sm2debugstr,keystr,68);
  723. }
  724. writeSM2key(keynew,keystr); //保存新公钥
  725. IEC104_SM2Echo(pt,sm2dat);
  726. break;
  727. }
  728. default:
  729. break;
  730. }
  731. }
  732. }
  733. }
  734. /***************下面为空函数**************************/
  735. int SM2_GenerateRandom_me(unsigned int uiLength, unsigned char *pucRandom)
  736. {
  737. int i;
  738. for(i=0;i<uiLength;i++)
  739. {
  740. pucRandom[i]=0;
  741. }
  742. pucRandom[0]=0x1f;
  743. pucRandom[1]=0xBB;
  744. pucRandom[2]=0x36;
  745. pucRandom[3]=0x82;
  746. return 0;
  747. }
  748. unsigned char SM2TestYKOKFrame[256]={0x16,0x4A,0x40,0x16,0x3B,0x26,0x3E,0x3F,0x3F,0x26,0x2E,0x17,0x43,0x68,0xFB,0x7A,0x49,0x51,0x19,0x4E,0x34,0x06,0x78,0x02,0xC4,0x62,
  749. 0x32,0xF1,0x72,0x0A,0x34,0x7C,0x12,0x69,0x50,0x50,0x74,0x4C,0xC9,0xE1,0xA4,0xCD,0xAE,0x5D,0xF8,0x05,0x2F,0xA9,0x54,0xD2,0x99,0x73,
  750. 0x28,0x4A,0x23,0x85,0xEA,0x27,0xB4,0xC2,0x56,0x35,0xDE,0x74,0xD2,0xEE,0x92,0x8F,0x68,0xB1,0x61,0xAC,0xB3,0xEE,0xD5,0x5C,0xC3,0xD2,
  751. 0x9B,0x16};
  752. unsigned char SM2Test104YKOKFrame[256]=
  753. {
  754. 0x16,0x4a,0x40,0x16,0x4e,0xbf,0x01,0x00,0xbf,0xbf,0x30,0xa8,0x69,0xee,0x75,0x2b,0xa3,0x7d,0x51,0x14,0x4b,0xc1,0x12,
  755. 0x07,0x83,0x85,0x8f,0x00,0x91,0xed,0x3e,0xe6,0x17,0xd5,0x59,0x15,0x4d,0xd4,0x98,0x36,0x17,0x6f,0x85,0x29,0x41,0xa2,
  756. 0xc5,0xcb,0xac,0x37,0x4c,0x0f,0x7a,0xa9,0x6b,0x17,0x38,0xef,0x4f,0x92,0x7c,0x5d,0x52,0xc6,0x18,0x25,0x63,0x33,0x46,
  757. 0xf4,0x48,0xf9,0x46,0x76,0xf1,0x19,0x80,0x59,0x40,0x16
  758. };
  759. unsigned char SM2YKOKFrame[256]={0x68,0x0C,0x0C,0x68,0x53,0x01,0x00,0x2E,0x01,0x06,0x00,0x01,0x00,0x02,0x60,0x82,0x6E,0x16};
  760. unsigned char SM2YK104OKFrame[256]=
  761. {
  762. 0x68,0x0e,0x12,0x00,0xa0,0x00,0x2d,0x01,0x06,0x00,0x01,0x00,0x01,0x60,0x00,0x81
  763. };
  764. unsigned char SM2TestYKERRFrame[256]={0x16,0x4A,0x40,0x16,0x33,0xC2,0x01,0x00,0xC2,0xC2,0xBA,0x28,0xBE,0x8C,0xAE,0x79,0x91,0xFE,0x21,0xFE,0x65,0xE4,0xBE,0x27,0xE1,
  765. 0xA0,0x5A,0x0A,0x53,0x86,0xC4,0x4A,0x53,0x33,0x36,0x16,0x10,0x4F,0x48,0xEA,0x24,0xF8,0x0B,0x7D,0x21,0x76,0x91,0x7A,0xCF,0x17,
  766. 0x8E,0x7C,0x8F,0x53,0x67,0xE7,0x61,0x73,0xE2,0xB6,0x9B,0xDE,0x6C,0xB2,0xB3,0x35,0xDD,0xF7,0x13,0x9B,0x99,0xC5,0x92,0xD1,0xF3,
  767. 0x2B,0xED,0xBB,0x3D,0x16};
  768. unsigned char SM2YKERRFrame[256]={0x68,0x0C,0x0C,0x68,0x53,0x01,0x00,0x2E,0x01,0x06,0x00,0x01,0x00,0x02,0x60,0x82,0x6E,0x16};
  769. unsigned char SM2YK104ERRFrame[256]={0x68, 0x0E, 0x1C, 0x00, 0x40, 0x00, 0x2D, 0x01, 0x06, 0x00, 0x01, 0x00, 0x01, 0x60, 0x00, 0x81};
  770. unsigned char SM2TestKeyFrame[256]={
  771. 0x16,0x4E,0x40,0x16,0x92,0x6E,0x01,0x00,0x6E,0x6E,0x5F,0x28,0x12,0x20,0x1F,0xBB,0x58,0xEC,0x6E,0x76,0xF3,0xBE,0x6A,0x54,
  772. 0x25,0x12,0xDE,0x78,0xAB,0x99,0xB3,0x54,0x57,0xED,0x4A,0x6B,0xD0,0xD4,0xE9,0x1E,0x80,0xDB,0xD7,0x9F,0x56,0x48,0xCB,0xBB,
  773. 0xC7,0x2D,0xB9,0x9B,0x74,0xAC,0xF0,0x8D,0xC8,0x36,0x5A,0xB1,0x70,0x6D,0xC8,0xFA,0xC6,0x39,0x5E,0x1D,0x57,0x32,0xB5,0x2F,
  774. 0xFE,0xBA,0x58,0xE5,0x45,0x99,0x87,0x2E,0x4F,0x91,0x91,0x16};
  775. extern union u_RsIEC g_tRsIEC[CFG_UART_NUM_MAX]; // 串口规约共用结构buf区,目前有101 104规约
  776. int stack_test(void)
  777. {
  778. return 0;
  779. }
  780. int encrypt_test(void)
  781. {
  782. IEC101_DEF *pt=(IEC101_DEF*)&g_tRsIEC;
  783. int i;
  784. tRunPara.byAddr=1;
  785. rt_printf("IEC101遥控测试 begin....\r\n");
  786. for(i=0;i<160;i++)
  787. {
  788. pt->recvbuf[256+i]=SM2TestYKOKFrame[i];
  789. }
  790. for(i=0;i<160;i++)
  791. {
  792. pt->recvbuf[i]=SM2YKOKFrame[i];
  793. }
  794. #if 0
  795. { // //防止时间戳无效
  796. TIME ct;
  797. // struct timespec ts;
  798. // struct rtc_time_t rtc;
  799. ct.ms=44000;
  800. ct.min=43;
  801. ct.hour=16;
  802. ct.day=13;
  803. ct.month=7;
  804. ct.year=35;
  805. sys_time_set_rmt(&ct);
  806. }
  807. #else
  808. { // //防止时间戳无效
  809. TIME ct;
  810. // struct timespec ts;
  811. // struct rtc_time_t rtc;
  812. ct.ms=2760;
  813. ct.min=32;
  814. ct.hour=14;
  815. ct.day=23;
  816. ct.month=9;
  817. ct.year=11;
  818. sys_time_set_rmt(&ct);
  819. }
  820. #endif
  821. IEC101_SM2(pt);
  822. rt_printf("遥控测试 end\r\n\r\n");
  823. rt_printf("\r\nIEC101遥控错误测试 begin....\r\n");
  824. for(i=0;i<160;i++)
  825. {
  826. pt->recvbuf[256+i]=SM2TestYKERRFrame[i];
  827. }
  828. for(i=0;i<160;i++)
  829. {
  830. pt->recvbuf[i]=SM2YKERRFrame[i];
  831. }
  832. #if 0
  833. tSysTime.ms=2761; //防止时间戳无效
  834. tSysTime.min=32;
  835. tSysTime.hour=14;
  836. tSysTime.day=23;
  837. tSysTime.month=9;
  838. tSysTime.year=11;
  839. #endif
  840. IEC101_SM2(pt);
  841. rt_printf("\r\n遥控错误测试 end\r\n");
  842. rt_printf("\r\nIEC101证书检查测试 begin....\r\n");
  843. for(i=0;i<160;i++)
  844. {
  845. pt->recvbuf[256+i]=SM2TestKeyFrame[i];
  846. }
  847. #if 0
  848. tSysTime.ms=2762; //防止时间戳无效
  849. tSysTime.min=32;
  850. tSysTime.hour=14;
  851. tSysTime.day=23;
  852. tSysTime.month=9;
  853. tSysTime.year=11;
  854. #endif
  855. IEC101_SM2(pt);
  856. rt_printf("\r\n证书检查测试 end\r\n");
  857. /*********************下面是104加密测试******************************/
  858. {
  859. IEC104_DEF *pt104=(IEC104_DEF*)&g_t104[0];
  860. rt_printf("IEC104遥控测试 begin....\r\n");
  861. for(i=0;i<160;i++)
  862. {
  863. pt104->arrRecvBuf[256+i]=SM2Test104YKOKFrame[i];
  864. }
  865. for(i=0;i<160;i++)
  866. {
  867. pt104->arrRecvBuf[i]=SM2YK104OKFrame[i];
  868. }
  869. { // //防止时间戳无效
  870. TIME ct;
  871. ct.ms=16000;
  872. ct.min=04;
  873. ct.hour=19;
  874. ct.day=5;
  875. ct.month=7;
  876. ct.year=13;
  877. sys_time_set_rmt(&ct);
  878. }
  879. IEC104_SM2(pt104);
  880. rt_printf("遥控测试 end\r\n\r\n");
  881. rt_printf("\r\nIEC104遥控错误测试 begin....\r\n");
  882. for(i=0;i<160;i++)
  883. {
  884. pt104->arrRecvBuf[256+i]=SM2TestYKERRFrame[i];
  885. }
  886. for(i=0;i<160;i++)
  887. {
  888. pt104->arrRecvBuf[i]=SM2YK104ERRFrame[i];
  889. }
  890. #if 1
  891. { // //防止时间戳无效
  892. TIME ct;
  893. ct.ms=2761;
  894. ct.min=32;
  895. ct.hour=14;
  896. ct.day=23;
  897. ct.month=9;
  898. ct.year=11;
  899. sys_time_set_rmt(&ct);
  900. }
  901. #endif
  902. IEC104_SM2(pt104);
  903. rt_printf("\r\n遥控错误测试 end\r\n");
  904. rt_printf("\r\nIEC104证书检查测试 begin....\r\n");
  905. for(i=0;i<160;i++)
  906. {
  907. pt104->arrRecvBuf[256+i]=SM2TestKeyFrame[i];
  908. }
  909. #if 0
  910. tSysTime.ms=2762; //防止时间戳无效
  911. tSysTime.min=32;
  912. tSysTime.hour=14;
  913. tSysTime.day=23;
  914. tSysTime.month=9;
  915. tSysTime.year=11;
  916. #endif
  917. IEC104_SM2(pt104);
  918. rt_printf("\r\n证书检查测试 end\r\n");
  919. }
  920. return 0;
  921. }
  922. #endif