mba32a.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659
  1. #include "mba32a.h"
  2. #include "usart.h"
  3. #include "interface.h"
  4. extern UART_HandleTypeDef huart5;
  5. extern Menu_table menu;
  6. BtFrame btframe;
  7. uint8_t resetcount_bt=0;
  8. uint16_t resetFlag16=0;
  9. BtStep btstep;
  10. uint16_t u5length=0;
  11. bool resetBTmodule = false;
  12. uint16_t displayNum=0;
  13. uint16_t bt_dataLength=0; //bt接收有效数据长度
  14. uint8_t bt_error_num=0; //bt接收的错误事件
  15. uint32_t bt_serial_num=0; //bt接收的流水号
  16. uint8_t bt_battery=0; //bt剩余电量百分比
  17. uint8_t bt_log_num=0; //bt记录事件数量
  18. uint8_t bt_lock_machinesta=0; //bt锁(电机)状态(0x00开;0x01关;0x02异常)
  19. uint8_t bt_lock_ropesta=0; //bt锁(锁绳)状态(0x00插入;0x01拔出)
  20. uint16_t bt_hwver=0; //bt硬件版本号
  21. uint16_t bt_sfver=0; //bt软件版本号
  22. uint8_t g_MBA32A_8buf[2048]={0}; //蓝牙接收数组
  23. uint8_t g_MBA32A_8buf_Down[2048]={0} ; //蓝牙搬移数组
  24. void MBA32AReset(void);
  25. uint8_t sendCmd_BT(char *pCmd,char *pRes, uint32_t timeOut, uint8_t sendNum);
  26. uint8_t DtuBtKey[16] = {0x4A, 0x49, 0x41, 0x4C, 0x4F, 0x4E, 0x47, 0x5F, 0x32, 0x40, 0x38, 0x21, 0x35, 0x23, 0x39, 0x32};//JIALONG_2@8!5#92
  27. uint8_t iv[16] = {0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31};//偏移
  28. /**
  29. * @breaf 蓝牙启动位读写检查
  30. */
  31. void Start_Read_resetFlag16(void)
  32. {
  33. resetFlag16 = read_flash_16(resetDevAddr);
  34. if(resetFlag16==0xFFFF)//开机检测(首次启动)
  35. {
  36. if(sendCmd_BT("AT+RESET=1\r\n","OK",1,1))
  37. {
  38. Write_Information(resetDevAddr, 0xAAAA);//写入0xAAAA
  39. printf("###复位设备成功\r\n");
  40. btstep = UUIDS;
  41. }
  42. }
  43. else if(resetFlag16==0xAAAA)//开机检测(大于1次启动)
  44. {
  45. printf("###蓝牙模块非首次启动\r\n");
  46. if (!sendCmd_BT("AT+UUIDS?\r\n","+UUIDS:0002",1,1))
  47. {
  48. PRINT_NUUID("UUIDS");//UUID项不符合
  49. btstep = UUIDS;
  50. }
  51. if (!sendCmd_BT("AT+UUIDN?\r\n","+UUIDN:FF04",1,1))
  52. {
  53. PRINT_NUUID("UUIDN");//UUID项不符合
  54. btstep = UUIDN;
  55. }
  56. if (!sendCmd_BT("AT+UUIDW?\r\n","+UUIDW:FFF5",1,1))
  57. {
  58. PRINT_NUUID("UUIDW");//UUID项不符合
  59. btstep = UUIDW;
  60. }
  61. else
  62. {
  63. PRINT_UUID("UUID项");//UUID项符合设置项
  64. btstep = BtStepDefault;
  65. }
  66. }
  67. }
  68. /**
  69. * @breaf 蓝牙初始化,工作接口
  70. */
  71. void MBA32A_Init(void)
  72. {
  73. btframe.userId = 0x64747531;
  74. btframe.Autoseal = 0xFF; \
  75. printf("\t###01\tBT_init%d...\r\n", resetcount_bt);
  76. Start_Read_resetFlag16();/** 启动位读写检查 **/
  77. if(sendCmd_BT("AT+DISCONN=0\r\n","ERROR",1,1))//断开连接
  78. {
  79. printf("#已无设备连接\n");
  80. }
  81. switch(btstep)
  82. {
  83. case BtStepDefault:
  84. break;
  85. case UUIDS:
  86. {
  87. if(sendCmd_BT("AT+UUIDS?\r\n","+UUIDS:FFF0",1,1))//蓝牙芯片默认值,需要修改
  88. {
  89. if(sendCmd_BT("AT+UUIDS=0002\r\n","OK",1,1))
  90. {
  91. printf("#01设置主服务成功\n");
  92. btstep++;
  93. }
  94. }
  95. else
  96. { //ERROR 其他值
  97. MBA32AReset();
  98. break;
  99. }
  100. }
  101. case UUIDN:
  102. {
  103. if(sendCmd_BT("AT+UUIDN?\r\n","+UUIDN:FFF1",1,1))//蓝牙芯片默认值,需要修改
  104. {
  105. if(sendCmd_BT("AT+UUIDN=FF04\r\n","OK",1,1))
  106. {
  107. printf("#02设置读服务成功\n");
  108. btstep++;
  109. }
  110. }
  111. else
  112. { //ERROR 其他值
  113. MBA32AReset();
  114. break;
  115. }
  116. }
  117. case UUIDW:
  118. {
  119. if(sendCmd_BT("AT+UUIDW?\r\n","+UUIDW:FFF2",1,1))//蓝牙芯片默认值,需要修改
  120. {
  121. if(sendCmd_BT("AT+UUIDW=FFF5\r\n","OK",1,1))
  122. {
  123. printf("#03设置写服务成功\n");
  124. btstep++;
  125. }
  126. }
  127. else
  128. { //ERROR 其他值
  129. MBA32AReset();
  130. break;
  131. }
  132. }
  133. }
  134. menu.current=0;//回到初始
  135. refresh=true;
  136. }
  137. /**
  138. * @breaf 串口发送命令子函数
  139. */
  140. void USART_SendString(UART_HandleTypeDef *huart,char *str)
  141. {
  142. printf("\r\nCMD:\t");
  143. HAL_UART_Transmit(huart, (uint8_t*)str, strlen(str), 0xFFFF);
  144. HAL_UART_Transmit(&huart3, (uint8_t*)str, strlen(str), 0xFFFF);
  145. }
  146. /**
  147. * @breaf 模块复位函数(接收数组清0)
  148. */
  149. void MBA32AReset(void)
  150. {
  151. resetcount_bt+=1;
  152. printf("Bt reset\r\n");
  153. HAL_GPIO_WritePin(REST_BT_GPIO_Port,REST_BT_Pin,GPIO_PIN_RESET);
  154. HAL_Delay(4000);
  155. btstep = UUIDS;
  156. resetBTmodule=true;//freertos监测模块重启位
  157. }
  158. void Echo_BT(uint8_t echosize)
  159. {
  160. HAL_UART_Transmit(&huart3,g_MBA32A_8buf_Down, echosize, 0xFFFF);//TTL回显
  161. }
  162. /**
  163. * @breaf 串口发送命令,有接收数组比较函数
  164. */
  165. uint8_t sendCmd_BT(char *pCmd,char *pRes, uint32_t timeOut, uint8_t sendNum)
  166. {
  167. uint8_t i = 0;
  168. uint32_t time;
  169. for(i = 0; i < sendNum; i++)
  170. {
  171. time = timeOut * 10;
  172. USART_SendString(&huart5, pCmd);
  173. HAL_Delay(30);
  174. printf("------->%s",g_MBA32A_8buf_Down);
  175. while(time--)
  176. {
  177. if(strstr((const char *)g_MBA32A_8buf_Down, pRes) != NULL) // 如果检索到关键词
  178. {
  179. memset(g_MBA32A_8buf_Down,0,50);
  180. return 1;
  181. }
  182. HAL_Delay(100);
  183. }
  184. }
  185. return 0;
  186. }
  187. void lock_searchInfo(void) //蓝牙查询信息帧
  188. {
  189. uint8_t header[2] = {0x66, 0x01};//Jl_lock帧头
  190. uint8_t serchInfo_CMD[] = {0x01, 0x00};//查询信息命令帧
  191. sendCombinedArray(header,sizeof(header),serchInfo_CMD,sizeof(serchInfo_CMD),0);
  192. Echo_BT(20);
  193. }
  194. /**
  195. * @breaf 蓝牙开锁信息帧
  196. */
  197. void open_lock(BtFrame btframe) //蓝牙开锁信息帧
  198. {
  199. uint8_t header[2] = {0x66, 0x01};//Jl_lock帧头
  200. uint8_t open_CMD[] = {0x02, 0x0C, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, \
  201. 0x00,0x00,0x00,0x00, 0x00};//开锁命令帧
  202. uint32_t serialNum;
  203. if(menu.current==4)
  204. {
  205. serialNum = btframe.serialNum1;//流水号
  206. }
  207. if(menu.current==5)
  208. {
  209. serialNum = btframe.serialNum2;//流水号
  210. }
  211. if(menu.current==6)
  212. {
  213. serialNum = btframe.serialNum3;//流水号
  214. }
  215. if(menu.current==7)
  216. {
  217. serialNum = btframe.serialNum4;//流水号
  218. }
  219. open_CMD[2]=(serialNum>>24) & 0xff;
  220. open_CMD[3]=(serialNum>>16) & 0xff;
  221. open_CMD[4]=(serialNum>>8) & 0xff;
  222. open_CMD[5]= serialNum & 0xff;
  223. uint32_t userid = btframe.userId;//用户id
  224. open_CMD[6]=(userid>>24) & 0xff;
  225. open_CMD[7]=(userid>>16) & 0xff;
  226. open_CMD[8]=(userid>>8) & 0xff;
  227. open_CMD[9]= userid & 0xff;
  228. uint32_t ntime = btframe.Ntime;//现在时间
  229. open_CMD[10]=(ntime>>24) & 0xff;
  230. open_CMD[11]=(ntime>>16) & 0xff;
  231. open_CMD[12]=(ntime>>8) & 0xff;
  232. open_CMD[13]= ntime & 0xff;
  233. open_CMD[14] = btframe.Autoseal;//自动施封时间
  234. sendCombinedArray(header,sizeof(header),open_CMD,sizeof(open_CMD),1);//加密
  235. Echo_BT(20);
  236. }
  237. /**
  238. * @breaf 蓝牙关锁信息帧
  239. */
  240. void close_lock(BtFrame btframe) //蓝牙关锁信息帧
  241. {
  242. uint8_t header[2] = {0x66, 0x01};//Jl_lock帧头
  243. uint8_t close_CMD[] = {0x03, 0x0B, 0x00,0x00,0x00,0x00, 0x00,0x00,0x00,0x00, \
  244. 0x00,0x00,0x00,0x00};//关锁命令帧
  245. uint32_t serialNum;
  246. if(menu.current==4)
  247. {
  248. serialNum = btframe.serialNum1;//流水号
  249. }
  250. if(menu.current==5)
  251. {
  252. serialNum = btframe.serialNum2;//流水号
  253. }
  254. if(menu.current==6)
  255. {
  256. serialNum = btframe.serialNum3;//流水号
  257. }
  258. if(menu.current==7)
  259. {
  260. serialNum = btframe.serialNum4;//流水号
  261. }
  262. close_CMD[2]=(serialNum>>24) & 0xff;
  263. close_CMD[3]=(serialNum>>16) & 0xff;
  264. close_CMD[4]=(serialNum>>8) & 0xff;
  265. close_CMD[5]= serialNum & 0xff;
  266. uint32_t userid = btframe.userId;//用户id
  267. close_CMD[6]=(userid>>24) & 0xff;
  268. close_CMD[7]=(userid>>16) & 0xff;
  269. close_CMD[8]=(userid>>8) & 0xff;
  270. close_CMD[9]= userid & 0xff;
  271. uint32_t ntime = btframe.Ntime;//现在时间
  272. close_CMD[10]=(ntime>>24) & 0xff;
  273. close_CMD[11]=(ntime>>16) & 0xff;
  274. close_CMD[12]=(ntime>>8) & 0xff;
  275. close_CMD[13]= ntime & 0xff;
  276. sendCombinedArray(header,sizeof(header),close_CMD,sizeof(close_CMD),1);
  277. Echo_BT(20);
  278. }
  279. void workinfo_W(void)
  280. {
  281. if(*g_MBA32A_8buf_Down == NULL)
  282. return;
  283. // if(g_MBA32A_8buf_Down[0]==0x66 && g_MBA32A_8buf_Down[1]==0x00 )//未加密帧头(命令字0x01)
  284. // {
  285. // if(g_MBA32A_8buf_Down[2]==0x01)
  286. // {
  287. // bt_dataLength = g_MBA32A_8buf_Down[3];//接收数据长度
  288. // bt_error_num = g_MBA32A_8buf_Down[4]; //错误事件数
  289. // // 将4个字节存入 bt_serial_num流水号
  290. // bt_serial_num |= g_MBA32A_8buf_Down[5]<<24;
  291. // bt_serial_num |= g_MBA32A_8buf_Down[6]<<16;
  292. // bt_serial_num |= g_MBA32A_8buf_Down[7]<<8;
  293. // bt_serial_num |= g_MBA32A_8buf_Down[8];
  294. // bt_battery = g_MBA32A_8buf_Down[9]; //电量百分比
  295. // bt_log_num = g_MBA32A_8buf_Down[10];//记录型事件
  296. // bt_lock_machinesta = g_MBA32A_8buf_Down[11]; //电机状态
  297. // bt_lock_ropesta = g_MBA32A_8buf_Down[12]; //锁绳状态
  298. // bt_hwver |= g_MBA32A_8buf_Down[13]<<8; //硬件版本号
  299. // bt_hwver |= g_MBA32A_8buf_Down[14];
  300. // bt_sfver |= g_MBA32A_8buf_Down[15]<<8; //软件版本号
  301. // bt_sfver |= g_MBA32A_8buf_Down[16];
  302. // }
  303. // }
  304. if(g_MBA32A_8buf_Down[0]==0x66 && g_MBA32A_8buf_Down[1]==0x01 )//加密帧头(命令字0x01)
  305. {
  306. if(g_MBA32A_8buf_Down[2]==0x01)
  307. {
  308. bt_dataLength = g_MBA32A_8buf_Down[3];//接收数据长度
  309. bt_error_num = g_MBA32A_8buf_Down[4]; //错误事件数
  310. // 将4个字节存入 bt_serial_num流水号
  311. bt_serial_num |= g_MBA32A_8buf_Down[5]<<24;
  312. bt_serial_num |= g_MBA32A_8buf_Down[6]<<16;
  313. bt_serial_num |= g_MBA32A_8buf_Down[7]<<8;
  314. bt_serial_num |= g_MBA32A_8buf_Down[8];
  315. bt_battery = g_MBA32A_8buf_Down[9]; //电量百分比
  316. bt_log_num = g_MBA32A_8buf_Down[10];//记录型事件
  317. bt_lock_machinesta = g_MBA32A_8buf_Down[11]; //电机状态
  318. bt_lock_ropesta = g_MBA32A_8buf_Down[12]; //锁绳状态
  319. bt_hwver |= g_MBA32A_8buf_Down[13]<<8; //硬件版本号
  320. bt_hwver |= g_MBA32A_8buf_Down[14];
  321. bt_sfver |= g_MBA32A_8buf_Down[15]<<8; //软件版本号
  322. bt_sfver |= g_MBA32A_8buf_Down[16];
  323. }
  324. }
  325. // if (L1bd)
  326. // {
  327. // displayNum |= 0x1000;
  328. // }
  329. // if (L2bd)
  330. // {
  331. // displayNum |= 0x0100;
  332. // }
  333. // if (L3bd)
  334. // {
  335. // displayNum |= 0x0010;
  336. // }
  337. // if (L4bd)
  338. // {
  339. // displayNum |= 0x0001;
  340. // }
  341. //
  342. //
  343. //
  344. // //0x1000 1开
  345. // //0xF000 1关
  346. // //0x1100 1开2开
  347. // //0xFF00 1关2关
  348. // if(bt_lock_machinesta==0x00 && bt_lock_ropesta==0x01)//电机打开锁绳插入——开
  349. // {
  350. // if (displayNum == 0x1000 || displayNum == 0x0100 || displayNum == 0x1100)//1 2 12
  351. // {
  352. // menu.home = displayNum;
  353. // }
  354. // }
  355. // if(bt_lock_machinesta==0x00 && bt_lock_ropesta==0x01)//电机打开锁绳拔出——开
  356. // {
  357. // if (displayNum == 0x1000 || displayNum == 0x0100 || displayNum == 0x1100)//1 2 12
  358. // {
  359. // menu.home = displayNum;
  360. // }
  361. // }
  362. //
  363. // if(bt_lock_machinesta==0x01 && bt_lock_ropesta==0x00)//电机关闭锁绳插入——关
  364. // {
  365. // if(displayNum==0x1100)//12绑定
  366. // {
  367. // menu.home=0xFF00;
  368. // }
  369. // if(displayNum==0x1000)//1绑定
  370. // {
  371. // menu.home=0xF000;
  372. // }
  373. // if(displayNum==0x0100)//2绑定
  374. // {
  375. // menu.home=0x0F00;
  376. // }
  377. // }
  378. // if(bt_lock_machinesta==0x01 && bt_lock_ropesta==0x00)//电机关闭锁绳拔出——开
  379. // {
  380. // if (displayNum == 0x1000 || displayNum == 0x0100 || displayNum == 0x1100)//1 2 12
  381. // {
  382. // menu.home = displayNum;
  383. // }
  384. // }
  385. }
  386. void open_close_lock(void)
  387. {
  388. if(menu.enter == 4 && (menu.current == 4 || menu.current == 5 || menu.current == 6 || menu.current == 7))
  389. {
  390. if(menu.current==4)
  391. {
  392. btframe.serialNum1 += 1;
  393. Write_Information(serialNum1Addr, btframe.serialNum1);
  394. //Sn1StatusAddr 0x1111 开 0x2222 关
  395. if(menu.up == 1)
  396. {
  397. close_lock(btframe); //施封操作
  398. Write_Information(Sn1StatusAddr, 0x2222);
  399. HAL_Delay(50);
  400. }
  401. else if(menu.up == 0)
  402. {
  403. open_lock(btframe); //解封操作
  404. Write_Information(Sn1StatusAddr, 0x1111);
  405. HAL_Delay(50);
  406. }
  407. }
  408. if(menu.current==5)
  409. {
  410. btframe.serialNum2 += 1;
  411. Write_Information(serialNum2Addr, btframe.serialNum2);
  412. //Sn1StatusAddr 0x1111 开 0x2222 关
  413. if(menu.up == 1)
  414. {
  415. close_lock(btframe); //施封操作
  416. Write_Information(Sn2StatusAddr, 0x2222);
  417. HAL_Delay(50);
  418. }
  419. else if(menu.up == 0)
  420. {
  421. open_lock(btframe); //解封操作
  422. Write_Information(Sn2StatusAddr, 0x1111);
  423. HAL_Delay(50);
  424. }
  425. }
  426. if(menu.current==6)
  427. {
  428. btframe.serialNum3 += 1;
  429. Write_Information(serialNum3Addr, btframe.serialNum3);
  430. //Sn1StatusAddr 0x1111 开 0x2222 关
  431. if(menu.up == 1)
  432. {
  433. close_lock(btframe); //施封操作
  434. Write_Information(Sn3StatusAddr, 0x2222);
  435. HAL_Delay(50);
  436. }
  437. else if(menu.up == 0)
  438. {
  439. open_lock(btframe); //解封操作
  440. Write_Information(Sn3StatusAddr, 0x1111);
  441. HAL_Delay(50);
  442. }
  443. }
  444. if(menu.current==7)
  445. {
  446. btframe.serialNum4 += 1;
  447. Write_Information(serialNum4Addr, btframe.serialNum4);
  448. //Sn1StatusAddr 0x1111 开 0x2222 关
  449. if(menu.up == 1)
  450. {
  451. close_lock(btframe); //施封操作
  452. Write_Information(Sn4StatusAddr, 0x2222);
  453. HAL_Delay(50);
  454. }
  455. else if(menu.up == 0)
  456. {
  457. open_lock(btframe); //解封操作
  458. Write_Information(Sn4StatusAddr, 0x1111);
  459. HAL_Delay(50);
  460. }
  461. }
  462. S1 = read_flash_16(Sn1StatusAddr);
  463. S2 = read_flash_16(Sn2StatusAddr);
  464. S3 = read_flash_16(Sn3StatusAddr);
  465. S4 = read_flash_16(Sn4StatusAddr);
  466. HAL_Delay(100);
  467. menu.enter=3;
  468. refresh = true;
  469. }
  470. }
  471. #include <stdio.h>
  472. #include <stdint.h>
  473. #include "dtuaes.h"
  474. int dtu_test(void) {
  475. //uint8_t i;
  476. struct AES_ctx ctx;
  477. // uint8_t in[16] = {0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f};
  478. // uint8_t iv[16] = {0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31};
  479. // uint8_t key[16] = {0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31};
  480. uint8_t DtuBtKey[16] = { 0x4A, 0x49, 0x41, 0x4C, 0x4F, 0x4E, 0x47, 0x5F, 0x32, 0x40, 0x38, 0x21, 0x35, 0x23, 0x39, 0x32 };//JIALONG_2@8!5#92
  481. uint8_t iv[16] = { 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31, 0x31 };
  482. uint8_t in[16] = { 0x02, 0x0C, 0x00, 0x00, 0x00, 0x02, 0x64, 0x74, 0x75, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10, 0x48 };
  483. // for (i = 0; i < sizeof(in); i++) {
  484. // printf("%02x ", DtuBtKey[i]);
  485. // }
  486. // printf("\n");
  487. AES_init_ctx_iv(&ctx, DtuBtKey, iv);
  488. AES_CBC_encrypt_buffer(&ctx, in, 16);
  489. // for (i = 0; i < sizeof(in); i++) {
  490. // printf("%02x ", in[i]);
  491. // }
  492. // printf("\n");
  493. // printf("Hello World!\n");
  494. return 0;
  495. }
  496. void updateMenu_s(uint16_t S, uint16_t mask, uint16_t value) {
  497. if (S == 0x1111) {
  498. if ((menu.home & mask) == mask) {
  499. menu.home = value;
  500. } else {
  501. menu.home |= value;
  502. }
  503. } else if (S == 0x2222) {
  504. menu.home |= mask;
  505. }
  506. }
  507. void modifyOledBmp(void)
  508. {
  509. #if updateMenu == 1
  510. updateMenu_s(S1, 0xF000, 0x1000);
  511. updateMenu_s(S2, 0x0F00, 0x0100);
  512. updateMenu_s(S3, 0x00F0, 0x0010);
  513. updateMenu_s(S4, 0x000F, 0x0001);
  514. #else
  515. if (S1 == 0x1111)
  516. {
  517. if(menu.home && 0xF000 == 0xF000)
  518. {
  519. menu.home = 0x1000;
  520. }
  521. else
  522. {
  523. menu.home |= 0x1000;
  524. }
  525. }
  526. if (S1 == 0x2222)
  527. {
  528. menu.home |= 0xF000;
  529. }
  530. if (S2 == 0x1111)
  531. {
  532. if(menu.home && 0x0F00 == 0x0F00)
  533. {
  534. menu.home = 0x0100;
  535. }
  536. else
  537. {
  538. menu.home |= 0x0100;
  539. }
  540. }
  541. if (S2 == 0x2222)
  542. {
  543. menu.home |= 0x0F00;
  544. }
  545. if (S3 == 0x1111)
  546. {
  547. if(menu.home && 0x00F0 == 0x00F0)
  548. {
  549. menu.home = 0x0010;
  550. }
  551. else
  552. {
  553. menu.home |= 0x0010;
  554. }
  555. }
  556. if (S3 == 0x2222)
  557. {
  558. menu.home |= 0x00F0;
  559. }
  560. if (S4 == 0x1111)
  561. {
  562. if(menu.home && 0x000F == 0x000F)
  563. {
  564. menu.home = 0x0001;
  565. }
  566. else
  567. {
  568. menu.home |= 0x0001;
  569. }
  570. }
  571. if (S4 == 0x2222)
  572. {
  573. menu.home |= 0x000F;
  574. }
  575. #endif
  576. //恢复null
  577. // if(S1==0xFFFF)
  578. // {
  579. // menu.home = menu.home & 0x0111;
  580. // }
  581. // if(S2==0xFFFF)
  582. // {
  583. // menu.home = menu.home & 0x1011;
  584. // }
  585. // if(S3==0xFFFF)
  586. // {
  587. // menu.home = menu.home & 0x1101;
  588. // }
  589. // if(S4==0xFFFF)
  590. // {
  591. // menu.home = menu.home & 0x1110;
  592. // }
  593. }