注册 登录
21ic电子技术开发论坛 返回首页

wangkuo0203的个人空间 https://bbs.21ic.com/?697112 [收藏] [复制] [RSS]

日志

Mark First STM8S003 CODE HERE

已有 601 次阅读2016-10-8 10:18 |个人分类:仪表|系统分类:单片机| STM8, 仪表


       
  1. /*************************************************
  2. * 2015/1/7 16:55:21
  3. * SX-C-5618 main file
  4. * Copyright (c) 2009-2015 Suxin-tech
  5. ************************************************/

  7. #include "stm8s003F3P.h"
  8. #include "typedef.h"
  9. #include "config.h"
  10. #include "display_lib.h"
  11. #include "ht1621.h"

  13. void system_init(void);
  14. uint8_t f_decode, plus_code, gear, gear_bak;

  16. uint8_t control, wink_cnt_left;
  17. uint8_t count, f_second, seconds, km;
  18. uint8_t left, right, light, d1,d2,d3, error, error2;
  19. uint32_t bat_sum, speed_sum, adj_sum, temp_sum;
  20. uint16_t bat_ad, speed_ad, adj_ad, temp_ad, voltage, change_count, hall; //voltage: 0.1V
  21. uint8_t bat, ad_cnt;
  22. uint8_t speed_max, speed_vol; // speed_vol:电机最大速度对应电压
  23. uint32_t mileage; // meter单位0.1米 mileage单位0.1km
  24. uint16_t mps, meter, single_m; // single_m 单次里程,单位0.1km
  25. uint8_t pmileage;
  26. uint8_t t2_count, dis_time, count2;

  28. uint16_t speed, speed_v, dec_cnt, inc_cnt,light_change, pre_light, light_cnt, ctr_cnt;
  29. uint16_t int_count=0, hall_count=0;

  31. const uint8_t lcd1[] = {num0, num1, num2, num3, num4, num5, num6, num7, num8, num9};
  32. const uint8_t lcd2[] = {num20, num21, num22, num23, num24, num25, num26, num27, num28, num29};

  34. void delay(uint32_t a)
  35. {
  36. if(a == 0)
  37. return;
  38. while(a--);
  39. }

  41. uint8_t select;
  42. uint8_t lcd[32];
  43. void lcd_init(void)
  44. {
  45. SendCmd(BIAS); //设置偏压和占空比
  46. SendCmd(SYSEN); //打开系统振荡器
  47. SendCmd(LCDON); //打开LCD偏压发生器 
  48. WriteAll_1621(0,lcd,32);
  49. }

  51. uint16_t get_ad(uint8_t channel)
  52. {
  53. uint16_t ad_result;
  54. ADC_CSR = channel;
  55. ADC_CR1 |= 0x01;
  56. while((ADC_CSR & 0x80) == 0x00);
  57. ad_result = ADC_DRL;
  58. ad_result += ((uint16_t)ADC_DRH << 8);
  59. return ad_result;
  60. }
  61. uint8_t ee_unlock(void)
  62. {
  63. uint8_t i = 0;
  64. do
  65. {
  66. FLASH_DUKR = 0xae;
  67. FLASH_DUKR = 0x56;
  68. i++;
  69. if(i > 10)
  70. break;
  71. } while((FLASH_IAPSR & 0x08) == 0);
  72. if(i > 10)
  73. return 1;
  74. else
  75. return 0;
  76. }

  78. void ee_lock(void)
  79. {
  80. FLASH_IAPSR &= ~0x08;
  81. }
  82. uint16_t _FULL[] = { 485, 603, 645, 725, 805, 965 };
  83. uint16_t _EMPTY[] = { 425, 538, 580, 630, 705, 845 };
  84. uint16_t FULL, EMPTY, bat_per;
  85. #define DIVIDE 4

  87. uint16_t d_cnt;
  88. volatile uint8_t decode_cnt, pdecode, decode[12], ext_cnt;
  89. uint8_t plus_code;
  90. uint8_t online_count, batQuantity;
  91. void main(void)
  92. {
  93. uint8_t i, *pee;
  94. uint16_t temp;
  95. system_init();
  96. delay(5000);
  97. pee = (unsigned char *)0x4000;
  98. if(*pee == 0xa5)
  99. {
  100. pee++;
  101. pmileage = *pee;
  102. if((pmileage > 0x5c) || (pmileage < 0x10))
  103. goto reset_ee;
  104. else
  105. {
  106. pee = (unsigned char *)(0x4000+pmileage);
  107. mileage = *pee;
  108. pee++;
  109. mileage += ((uint16_t)(*pee) << 8);
  110. pee++;
  111. mileage += ((uint32_t)(*pee) << 16);
  112. pee++;
  113. mileage += ((uint32_t)(*pee) << 24);
  114. }
  115. if(mileage > 99999)
  116. mileage = 99999;
  117. pee = (unsigned char *)0x4002;
  118. select = 1;
  119. pee++;

  121. FULL = _FULL[select];
  122. EMPTY = _EMPTY[select];
  123. bat_per = ((uint8_t)((FULL-EMPTY)/DIVIDE));

  125. pee+=2;
  126. control = *pee;
  127. }
  128. else
  129. {
  130. reset_ee:
  131. pee = (unsigned char *)0x4000;
  132. if(ee_unlock() == 0) // eeprom解锁成功，写入数据
  133. {
  134. *pee++ = 0xa5;
  135. while((FLASH_IAPSR & 0x04) == 0);
  136. *pee++ = 0x10;
  137. while((FLASH_IAPSR & 0x04) == 0);
  138. *pee++ = 0x01;
  139. while((FLASH_IAPSR & 0x04) == 0);
  140. *pee++ = 0x00;
  141. while((FLASH_IAPSR & 0x04) == 0);
  142. *pee = 100;
  143. while((FLASH_IAPSR & 0x04) == 0);
  144. *pee = 0;
  145. while((FLASH_IAPSR & 0x04) == 0);
  146. pee = (unsigned char *)0x4010;
  147. for(i=0; i<4; ++i)
  148. {
  149. *pee++ = 0x00;
  150. while((FLASH_IAPSR & 0x04) == 0);
  151. }
  152. ee_lock();
  153. }
  154. pmileage = 0x10;
  155. mileage = 0;
  156. select = 0x01;
  157. FULL = _FULL[select];
  158. EMPTY = _EMPTY[select];
  159. bat_per = ((uint8_t)((FULL-EMPTY)/DIVIDE));
  160. control = 0;
  161. }
  162. speed_max = 38;
  163. speed_vol = 24;

  165. _asm("rim");
  166. delay(100000);
  167. for(i=0; i<32; ++i)
  168. lcd[i] = 0x00;
  169. bat_ad += get_ad(0x05);
  170. voltage = (bat_ad*53/50);
  171. if(voltage < EMPTY)
  172. bat = 5;
  173. else if(voltage > FULL-bat_per)
  174. bat = 0;
  175. else
  176. bat = (FULL - voltage)/bat_per;
  177. batQuantity = (5-bat) * 20;
  178. while (1)
  179. {
  180. if(f_decode)
  181. {
  182. f_decode = 0;
  183. online_count = 0;

  185. plus_code = 0;
  186. for(i=0; i<11; i++)
  187. plus_code ^= decode[i];
  188. if(plus_code == decode[11]) {
  189. plus_code = decode[10];
  190. for(i=3; i<11; i++)
  191. decode[i] -= plus_code;
  192. gear_bak = gear;
  193. gear = (decode[4] & 0x03); // 0~3 gear
  194. error2 = decode[4];
  195. error= (decode[3] & 0x7f);

  197. speed = ((uint16_t)decode[7]<<8)+decode[8];
  198. speed = speed * speed_max / 50;
  199. if(speed > 990)
  200. speed = 990;
  201. mps = speed * 10 / 36;
  202. }
  203. } 
  204. bat_sum += get_ad(0x05);
  205. speed_sum += get_ad(0x04);
  206. adj_sum += get_ad(0x03);
  207. if(online_count >= 50)
  208. {
  209. online_count = 0;
  210. gear = 0;
  211. gear_bak = 0;
  212. hall = 0;
  213. speed = 0;
  214. error2 = 0;
  215. error = 0;
  216. }
  217. if(++ad_cnt ==0)
  218. {
  219. speed_ad = speed_sum >> 8;
  220. bat_ad = bat_sum >> 8;
  221. adj_ad = adj_sum >> 8;
  222. adj_ad /= 17;
  223. adj_ad += 15; // adj 0-1023: 15-75
  224. speed_max = adj_ad;
  225. speed_sum = 0;
  226. bat_sum = 0;
  227. adj_sum = 0;
  228. ad_cnt = 0;

  230. voltage *= 1;
  231. voltage += (1*bat_ad*53/50); //bat_ad/1023*5*71.3/3.3*10(单位0.1V) = bat_ad * 1.056
  232. voltage >>= 1;
  233. if(voltage >= 1000)
  234. voltage = 999;
  235. }
  236. temp = speed;

  238. // speed_v = (uint32_t)speed_ad*speed_max/speed_vol; //speed_ad*5*71.3*speed_max/3.3/1023/speed_vol, mulby 10 ≈speed_ad*speed_max/speed_vol
  239. // speed = speed_v;
  240. // 
  241. // if(speed > 990)
  242. // speed = 990;
  243. // mps = speed * 10 / 36; //mps结果为整数，每秒mps/10米，即1m/s时mps=10，speed已经放大了10倍
  244. if((speed - temp < 40) || (temp - speed < 40))
  245. {
  246. if(speed > 5)
  247. speed = (speed + temp + 1) >> 1;
  248. }

  250. if(select < 6)
  251. {
  252. if(voltage < FULL-bat_per*bat-1)
  253. {
  254. if(++inc_cnt >= 1000)
  255. {
  256. inc_cnt = 0;
  257. if(bat < DIVIDE+1)
  258. {
  259. bat++;
  260. }
  261. }
  262. }
  263. else
  264. inc_cnt = 0;
  265. if(bat > 0)
  266. {
  267. if(voltage > FULL-bat_per*(bat-1))
  268. {
  269. if(++dec_cnt >= 1000)
  270. {
  271. dec_cnt = 0;
  272. bat--;
  273. }
  274. }
  275. else
  276. dec_cnt = 0;
  277. }
  278. else
  279. dec_cnt = 0;
  280. batQuantity = (5-bat) * 20;
  281. }
  282. if(f_second == 1)
  283. {
  284. f_second = 0;
  285. if(seconds < 10)
  286. seconds++;
  287. meter += mps;
  288. if(meter >= 1000) //100米 记录
  289. {
  290. meter = 0;
  291. single_m++;
  292. mileage ++;
  293. if(mileage > 999999)
  294. mileage = 999999;
  295. else
  296. {
  297. ee_unlock();
  298. if(pmileage != ((mileage / 100000) << 2) + 0x10)
  299. {
  300. pmileage = ((mileage / 100000) << 2) + 0x10;
  301. pee = (unsigned char *)(0x4001);
  302. *pee = pmileage;
  303. while((FLASH_IAPSR & 0x04) == 0);
  304. }

  306. pee = (unsigned char *)(0x4000 + pmileage);
  307. *pee++ = mileage & 0xff;
  308. while((FLASH_IAPSR & 0x04) == 0);
  309. *pee++ = mileage >> 8;
  310. while((FLASH_IAPSR & 0x04) == 0);
  311. *pee++ = mileage >> 16;
  312. while((FLASH_IAPSR & 0x04) == 0);
  313. *pee++ = mileage >> 24;
  314. while((FLASH_IAPSR & 0x04) == 0);
  315. ee_lock();
  316. }
  317. }
  318. }
  319. for(i=0; i<32; i++)
  320. lcd[i] = 0;

  322. //speed display
  323. lcd[0] = lcd1[speed / 100];
  324. lcd[1] = lcd1[speed / 100] >> 4;
  325. lcd[2] = lcd1[speed % 100 / 10];
  326. lcd[3] = lcd1[speed % 100 / 10] >> 4;
  327. lcd[3] |= 0x08;

  329. //mileage display
  330. lcd[6] = lcd1[mileage/100000]; 
  331. lcd[7] = lcd1[mileage/100000] >> 4; 
  332. lcd[16] = lcd1[mileage%100000/10000];
  333. lcd[17] = lcd1[mileage%100000/10000] >> 4;
  334. lcd[18] = lcd1[mileage%10000/1000]; 
  335. lcd[19] = lcd1[mileage%10000/1000] >> 4; 
  336. lcd[20] = lcd1[mileage%1000/100];
  337. lcd[21] = lcd1[mileage%1000/100] >> 4; 
  338. lcd[22] = lcd1[mileage%100/10];
  339. lcd[23] = lcd1[mileage%100/10] >> 4;
  340. lcd[7] |= 0x08;

  342. if(batQuantity >= 100) {
  343. lcd[24] = lcd1[0];
  344. lcd[25] = lcd1[0] >> 4;
  345. lcd[26] = lcd1[0];
  346. lcd[27] = lcd1[0] >> 4;
  347. lcd[23] |= 0x08;
  348. } else {
  349. lcd[24] = lcd1[batQuantity / 10];
  350. lcd[25] = lcd1[batQuantity / 10] >> 4;
  351. lcd[26] = lcd1[batQuantity % 10];
  352. lcd[27] = lcd1[batQuantity % 10] >> 4;
  353. }
  354. lcd[27] |= 8;
  355. switch(bat)
  356. {
  357. case 0: lcd[28] = 0x0f; lcd[17] |= 8; lcd[25] |= 8; break;
  358. case 1: lcd[28] = 0x0e; lcd[17] |= 8; lcd[25] |= 8; break;
  359. case 2: lcd[28] = 0x0c; lcd[17] |= 8; lcd[25] |= 8; break;
  360. case 3: lcd[28] = 0x08; lcd[17] |= 8; lcd[25] |= 8;break;
  361. case 4: lcd[28] = 0x08; lcd[25] |= 8;break;
  362. case 5: lcd[28] = 0x08; if(count2 > 25) lcd[25] |= 0x8;
  363. lcd[21] |= 0x08; break; // 'CA'
  364. default: break;
  365. }
  366. light = PC_IDR & (1 << 3);

  368. if(light != pre_light)
  369. {
  370. if(light_change == 0)
  371. light_cnt = 0;
  372. if(++light_change >= 10)
  373. {
  374. light_change = 0;
  375. single_m = 0;
  376. mileage = 0;
  377. ee_unlock();
  378. pee = (uint8_t*)0x4001;
  379. *pee = 0x10;
  380. while((FLASH_IAPSR & 0x04) == 0);
  381. pee = (unsigned char *)0x4010;
  382. for(i=0; i<4; ++i)
  383. {
  384. *pee++ = 0x00;
  385. while((FLASH_IAPSR & 0x04) == 0);
  386. }
  387. ee_lock();
  388. }
  389. }
  390. pre_light = light;

  392. if(light != 0)
  393. lcd[1] |= 0x8;
  394. if(gear_bak == gear)
  395. {
  396. PC_ODR |= 0xf0;
  397. if(gear > 3) gear = 0;
  398. switch(gear) {
  399. case 0: break;
  400. case 1: PC_ODR &= ~0x30; break;
  401. case 2: PC_ODR &= ~0xe0; break;
  402. case 3: PC_ODR &= ~0x70; break;
  403. default: break;
  404. }
  405. }

  407. if(speed >= 20) lcd[5] |= 0x01; 
  408. if(speed >= 60) lcd[5] |= 0x02; 
  409. if(speed >= 110) lcd[5] |= 0x04;
  410. if(speed >= 160) lcd[5] |= 0x08; 
  411. if(speed >= 210) lcd[4] |= 0x08; 
  412. if(speed >= 260) lcd[4] |= 0x04; 
  413. if(speed >= 310) lcd[4] |= 0x02; 
  414. if(speed >= 360) lcd[4] |= 0x01; 
  415. if(speed >= 410) lcd[30] |= 0x01;
  416. if(speed >= 460) lcd[30] |= 0x02;
  417. if(speed >= 510) lcd[30] |= 0x04;
  418. if(speed >= 560) lcd[30] |= 0x08;


  421. if(error & 0x41) // MOTOR ERROR
  422. lcd[29] |= 0x04;
  423. if(error & 0x2) // 助力
  424. ;// lcd[0] |= 0x04;
  425. if(error & 0x4) // 巡航
  426. ;// lcd[0] |= 0x08;
  427. if(error & 0x10) // ECU
  428. ;// lcd[30] |= 0x02;
  429. if(error & 0x20) // 转把
  430. lcd[29] |= 0x02;
  431. if(error2 & 0x08) // 充电
  432. ;// lcd[7] |= 0x04;
  433. if(error2 & 0x20) // 刹车
  434. lcd[29] |= 0x01;
  435. WriteAll_1621(0, lcd, 32);
  436. }
  437. }

  439. @far @interrupt void portb_int(void)
  440. {
  441. volatile uint16_t time;
  442. ext_cnt = 0;
  443. if(PB_IDR & 0x20) // posedge
  444. {
  445. if(TIM1_CR1 & 0x01) // TM1 already run, 
  446. {
  447. time = (TIM1_CNTRH << 8);
  448. time += TIM1_CNTRL;
  449. TIM1_CNTRH = 0;
  450. TIM1_CNTRL = 0;
  451. if((time >= 400) && (time <= 650)) // 1
  452. {
  453. decode[decode_cnt/8] <<= 1;
  454. decode[decode_cnt/8] |= 1;
  455. decode_cnt++;
  456. if(decode_cnt >= 96)
  457. {
  458. decode_cnt = 0;
  459. f_decode = 1;
  460. }
  461. pdecode++;
  462. if(pdecode >= 8)
  463. pdecode = 0;
  464. }
  465. else if((time >= 800) && (time <= 1300)) // 0
  466. {
  467. decode[decode_cnt/8] <<= 1;
  468. decode[decode_cnt/8] |= 0;
  469. decode_cnt++;
  470. if(decode_cnt >= 96)
  471. {
  472. decode_cnt = 0;
  473. f_decode = 1;
  474. }
  475. pdecode++;
  476. if(pdecode >= 8)
  477. pdecode = 0;
  478. }
  479. else
  480. {
  481. TIM1_CR1 &= ~0x01;
  482. }
  483. }
  484. }
  485. else // negative edge
  486. {
  487. if(TIM1_CR1 & 0x01) // TM1 already run
  488. {
  489. TIM1_CNTRH = 0;
  490. TIM1_CNTRL = 0;
  491. }
  492. else
  493. {
  494. TIM1_CR1 |= 0x01;
  495. pdecode = 0;
  496. decode_cnt = 0;
  497. TIM1_CNTRH = 0;
  498. TIM1_CNTRL = 0;
  499. }
  500. }
  501. }

  503. @far @interrupt void timer2Interrupt(void) /* set f = 500Hz */
  504. {
  505. TIM2_SR1 &= ~0x01;
  506. if(++ext_cnt > 10)
  507. {
  508. ext_cnt = 0;
  509. TIM1_CR1 &= ~0x01;
  510. } 
  511. if(++count >= 10) // 20ms
  512. {
  513. count = 0;
  514. if(++count2 >= 50)
  515. count2 = 0;
  516. if(++t2_count >= 50)
  517. {
  518. t2_count = 0;
  519. f_second = 1;

  521. if(light_cnt <5)
  522. {
  523. if(++light_cnt==5)
  524. {
  525. light_change = 0;
  526. }
  527. }
  528. }
  529. if((t2_count == 0) || (t2_count == 25))
  530. {
  531. hall_count += int_count;
  532. hall_count >>= 1;
  533. int_count = 0;

  535. if(++dis_time > 3)
  536. dis_time = 0;
  537. }
  538. if(wink_cnt_left != 0)
  539. wink_cnt_left--;
  540. else
  541. wink_cnt_left = 100;
  542. if(online_count < 50)
  543. online_count++;
  544. }
  545. }

  547. void adc_init(void)
  548. {
  549. ADC_CSR = 0x00; // disable adc interrupt
  550. ADC_CR2 = 0x08; // right alignment
  551. ADC_CR3 = 0x00; // disable data buffer
  552. // ADC_TDRL = 0x18; // Schmitt trigger disabled 
  553. ADC_CR1 = 0x71; // adc clock = fmaster / 18
  554. ADC_CR1 |= 0x01;
  555. }

  557. void port_init(void)
  558. {
  559. CFG_GCR = 0x01;
  560. _asm("nop");
  561. PA_DDR = 0x0e; // PA.123 output;
  562. PA_CR1 = 0x0e;
  563. PA_CR2 = 0x0e;
  564. PA_ODR = 0x0e;

  566. PB_DDR = 0x00; // PB.45 input;
  567. PB_CR1 = 0x00;
  568. PB_CR2 = 0x20; // PB5 input with interrupt

  570. PC_ODR = 0xf0;
  571. PC_DDR = 0xf0; // PC.34567 in
  572. PC_CR1 = 0xe0;
  573. PC_CR2 = 0x00; 

  575. PD_DDR = 0x00; // PD.123456 in 
  576. PD_CR1 = 0x00;
  577. PD_CR2 = 0x00;
  578. }
  579. void timer_init(void)
  580. {
  581. TIM2_IER = 0x01;
  582. TIM2_PSCR = 0x03; //prescaler = 2<3> = 8
  583. TIM2_ARRH = 0x07;
  584. TIM2_ARRL = 0xd0; // auto reload = 1000 @ 1ms
  585. TIM2_CR1 |= 0x01;
  586. TIM1_IER = 0x00;
  587. TIM1_PSCRL = 0x07; //prescaler = 7 + 1 = 8
  588. TIM1_ARRH = 0xff;
  589. TIM1_ARRL = 0xff; // auto reload = 65535 @ 65.5ms
  590. }

  592. void system_init(void)
  593. {
  594. uint8_t i;
  595. CLK_CKDIVR = 0x08; 
  596. _asm("nop");
  597. _asm("nop");
  598. _asm("nop");
  599. _asm("nop");
  600. CLK_PCKENR1 = 0xac;
  601. CLK_PCKENR2 = 0x08;
  602. port_init();
  603. adc_init();
  604. timer_init();
  605. // uart_init();
  606. delay(10000);
  607. EXTI_CR1 = 0x0c;
  608. for(i=0; i<32; ++i)
  609. lcd[i] = 0xff;
  610. lcd_init();
  611. }
复制代码


路过
鸡蛋
鲜花
握手
雷人
收藏 邀请 举报

全部作者的其他最新日志

评论 (0 个评论)