设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › MCU综合技术区 › 电子指南针源码GPL833F series 6502 CPU
返回列表 发新帖
查看: 2383|回复: 0
打印 上一主题 下一主题
收起左侧

电子指南针源码GPL833F series 6502 CPU

[复制链接]
跳转到指定楼层
楼主
ID:276976 发表于 2018-1-17 14:07 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
电子指南针所有资料51hei提供下载:
OW091-C.zip (754.47 KB, 下载次数: 11)

单片机源程序如下:
  1. /* ======================================================================= */
  2. /*    File Name   : main.c                                                 */
  3. /*    Description : main function for user program                         */
  4. /*    Body        : GPL833F series 6502 CPU                               */
  5. /*    Toolchain   : gp65cc Compiler V0.9x                                  */
  6. /*    Date        : 2014/09/09                                             */
  7. /*    Author      :                                                        */
  8. /*    Version     : 1.0.0                                                  */
  9. /* ======================================================================= */
  10. #include "GPL833F.h"
  11. #include"main.h"
  12. #include <math.h>
  13. #define shift_cant 16
  14. //void heat_index(void)__banked;
  15. void weath_read(void);
  16. void read_temp_hum_1(void);
  17. void read_temp_hum_2(void);

  19. void ow61_init(void)__banked;
  20. void clrr_dis_ram(void);
  21. void read_comp_data(void)__banked;
  22. void disp()__banked;
  23. void key_fun(void)__banked;
  24. void disp_time()__banked;
  25. void disp_temp()__banked;
  26. void press_unit()__banked;
  27. void disp_press()__banked;
  28. void disp_anlg()__banked;
  29. void disp_weath()__banked;
  30. void rfc_start()__banked;
  31. void dark_pres_unit()__banked;
  32. void dark_spend_unit()__banked;
  33. void spend_unit(void)__banked;


  36. unsigned char weath_mode=0;
  37. //void compass_calibration(void)__banked;

  39. unsigned char *display_buf;
  40. unsigned char comp_init_flag=0x1f,axis_test_time;
  41. unsigned int angle=0;       
  42. unsigned char cant_10s=0,key_stater=2,time_display_mode=0,pres_disp_mode=0;
  43. unsigned char cant_5s=0,weath_stater=1;
  44. unsigned char inc_8_time=0;
  45. unsigned char key_data=0;
  46. unsigned char press_max_stater=0,press_min_stater=0,press_stater1=0,press_stater2=0;
  47. unsigned char press_send_data,spend_danwei=3,press_danwei;
  48. unsigned long int press_read_data;
  49. unsigned char  canat_60_minute=0;
  50. unsigned char data_buf;
  51. unsigned char press_wait_time;
  52. unsigned long int press_data_buf=101625,press_data=101325;
  53. unsigned long int press_save_data=0;
  54.   float wr0,wr1,wr3,dis_spend=0,dis_spend1=5.6;
  55. int in_temp,in_hum,in_temp_f;
  56. unsigned int spend,spend1;
  57. long int wr4;
  58. unsigned char *pointer1;
  59. unsigned int wr5;
  60. unsigned int wr6;
  61. int high_value,high_value1=0;

  63. int save_shift_high=0;
  64. unsigned char fishing_data;
  65. unsigned char porta_buf;
  66. unsigned char portd_buf;
  67. unsigned char *pointer1;
  68. unsigned char compass_data;
  69. unsigned char flag0=0x10;//bit0半秒标志
  70.                                                  //bit1秒位置是显示周或秒标志
  71.                                                  //bit2表示上电第一次测气压
  72.                                                  //bit3表示温度单位是华氏度还是摄氏度0/1,C/F
  73.                                                  //bit4表示FISHING
  74.                                                  //bit5表示温度测量是否有错误
  75.                                                  //bit6表示测完温度或湿度
  76.                                                  //bit7表示正在测量温湿度
  77. unsigned char flag1=0x10;//bit0 风速测试ON/OFF 1/0
  78.                                                  //bit1 气压测试模式
  79.                                                  //bit2 开启/关闭 1/0指南针模块
  80.                                                  //bit3表示气压错误标志
  81.                                                  //bit4表示正在测气压
  82.                                                  //bit5表示完成方向测量
  83.                                                  //bit6表示测量方向是错误
  84.                                                  //bit7表示时间模式
  85. unsigned char flag2=2;        //bit0-bit4表示天气状态       
  86.                                                         //bit5表示短按
  87.                                                         //bit6表示长按
  88. unsigned char flag3=0xb4;//bit0 temp test done
  89.                                                         //bit1 hum test done
  90.                                                         //bit4 init 开始读指南针数据
  91.                                                         //bit5 time updata       
  92.                                                         //bit6 24/12hour       
  93.                                                         //bit7 rfc start/stop 1/0
  94. unsigned char flag4=0xf8;//bit0 rfc测完等待计算       
  95.                                                 //bit1 检测到按键
  96.                                                 //bit2 温度是用rf还是用sen
  97.                                                 //bit3 刷新时间显示
  98.                                                 //bit4 刷新天气图案显示
  99.                                                 //bit5刷新气压显示
  100.                                                 //bit6 刷新温度显示
  101.                                                 //bit7刷新角度显示
  102. unsigned char flag6=0;//1s标志
  103.                                           //bit1 指南针是否校验标志
  104. unsigned char flag5;//湿度和压力OFFSET
  105. unsigned char cant_30s=0,temp_test_time;       
  106. unsigned char year=17,moth=1,day=1,hour=0,mint=0,second=0,week_data=53;
  107. unsigned char cant_15s;
  108. unsigned int XRaw=0;
  109. unsigned int YRaw=0;
  110. unsigned char cant_3s;
  111. unsigned int Xoffset=0;
  112. unsigned int Yoffset=0;
  113. unsigned int Xsens=0;
  114. unsigned int Ysens=0;

  116. unsigned int X_raw=0,Y_raw=0;   
  117. unsigned int xmax=0,ymax=0,xmin=0,ymin=0;
  118. unsigned long int x_value=0,y_value=0;
  119. unsigned int Angle=0;
  120. unsigned int I2cAngleBuf[2];
  121. unsigned long int xvalue_buf,yvalue_buf;
  122. int dis_pres,disp_pres_num=10120;
  123. unsigned int rfc_ref,rfc_sen1,rfc_sen2;
  124. unsigned char cant_20s=0;
  125. unsigned char spend_on_5s=0;
  126. #define cood_char const unsigned int
  127. const        unsigned char moth_table[12]=
  128. {
  129.         31,28,31,30,31,30,31,31,30,31,30,31
  130. };
  131. void coter_20second();

  133. void time_inc(void)
  134. {
  135.         flag4|=0x08;
  136.         spend_on_5s++;
  137.         if(cant_10s<11)cant_10s++;
  138.         second++;
  139.         cant_30s++;
  140.         if(cant_15s<21)cant_15s++;
  141.         if(cant_5s<6)cant_5s++;
  142.         cant_3s++;
  143.         if(second>59)
  144.                 {
  145.                 second=0;
  146.                 mint++;
  147.                 canat_60_minute++;
  148.                 if(canat_60_minute>59)flag1|=0x10;
  149.                 }
  150.         if(mint>59){hour++;mint=0;}
  151.         if(hour>23){day++;hour=0;}
  152.         if(moth==2)
  153.                 {
  154.                 if(year&0x03)
  155.                         {
  156.                         if(day>28)day=1;
  157.                         }
  158.                 else
  159.                         {
  160.                         if(day>29)day=1;               
  161.                         }
  162.                 }
  163.         else if(day>moth_table[moth-1])
  164.                 {
  165.                 day=1;
  166.                 }
  167.         if(moth>12){year++;moth=1;}
  168.         if(year>99)year=16;
  169. }

  171. void rfc_init()
  172. {
  173.         static unsigned char stater=0,cant_2=0;
  174.         unsigned char d;
  175.         if(!(flag3&0x80))return;
  176.         if(flag4&0x04)return;
  177.         cant_2++;
  178.         if(cant_2<8)return;
  179.         cant_2=0;
  180.         switch(stater)
  181.                 {
  182.                 case 0:
  183.                         stater=1;
  184.                         P_CTS_Ctrl2&=~D_CTSStart;
  185.                         P_CTS_TM0Cnt_LB=0x00;
  186.                         P_CTS_TM0Cnt_HB=0x00;
  187.                         P_IO_RFC_Ctrl=0;
  188.                         P_IO_RFC_Ctrl=D_REF2En;
  189.                         rfc_ref=P_CTS_TM0Cnt_HB<<8;
  190.                         rfc_ref+=P_CTS_TM0Cnt_LB;
  191.                         P_CTS_Ctrl2|=D_CTSStart;
  192.                         break;
  193.                 case 1:
  194.                         P_CTS_Ctrl2&=~D_CTSStart;
  195.                         rfc_ref=P_CTS_TM0Cnt_HB<<8;
  196.                         rfc_ref+=P_CTS_TM0Cnt_LB;
  197.                         P_IO_RFC_Ctrl=0;
  198.                         P_IO_RFC_Ctrl=D_SEN2AEn;
  199.                         P_CTS_TM0Cnt_LB=0x00;
  200.                         P_CTS_TM0Cnt_HB=0x00;
  201.                         P_CTS_Ctrl2|=D_CTSStart;
  202.                         stater=2;
  203.                         break;
  204.                 case 2:
  205.                         P_CTS_Ctrl2&=~D_CTSStart;
  206.                         rfc_sen2=P_CTS_TM0Cnt_HB<<8;
  207.                         rfc_sen2+=P_CTS_TM0Cnt_LB;
  208.                         P_IO_RFC_Ctrl=0;
  209.                         P_IO_RFC_Ctrl=D_SEN2BEn;
  210.                         P_CTS_TM0Cnt_LB=0x00;
  211.                         P_CTS_TM0Cnt_HB=0x00;
  212.                         P_CTS_Ctrl2|=D_CTSStart;
  213.                         stater=3;
  214.                         break;
  215.                 case 3:
  216.                         P_CTS_Ctrl2&=~D_CTSStart;
  217.                         rfc_sen1=P_CTS_TM0Cnt_HB<<8;
  218.                         rfc_sen1+=P_CTS_TM0Cnt_LB;
  219.                         P_IO_Ctrl2&=~D_RFC2En;
  220.                         P_CTS_Ctrl2&=~D_CTSEn;
  221.                         P_IO_RFC_Ctrl=0;
  222.                         P_CTS_TM0Cnt_LB=0x00;
  223.                         P_CTS_TM0Cnt_HB=0x00;

  225.                         P_IO_PortB_Dir|=~0xf0;
  226.                         P_IO_PortB_Attrib&=~0x0f;
  227.                         P_IO_PortB_Data|=~0xf0;
  228.                         P_IO_PortB_Buffer&=0xf0;
  229.                         flag3&=0x7f;
  230.                         flag4|=0x01;
  231.                         stater=0;
  232.                         break;

  234.                 }
  235. }

  237. void scan_key(void)
  238. {
  239.         static unsigned char stater=0,old_key;
  240.         unsigned char i;
  241.         i=P_IO_PortA_Data&0xf0;
  242.         switch(stater)
  243.                 {
  244.                 case 0:       
  245.                         if(i!=0xf0)
  246.                                 {
  247.                                 if(i!=old_key)//等待安检稳定，可以检测组合键。
  248.                                         {
  249.                                         inc_8_time=0;
  250.                                         old_key=i;
  251.                                         }
  252.                                 else inc_8_time++;
  253.                                 }
  254.                         else
  255.                                 {
  256.                                 old_key=0;
  257.                                 inc_8_time=0;
  258.                                 }
  259.                         if(inc_8_time>13){stater=1;key_data=i;}//按键稳定了
  260.                         break;
  261.                 case 1:
  262.                                 if(i==0xf0)stater=2;
  263.                                 else
  264.                                         {
  265.                                         inc_8_time++;
  266.                                         }
  267.                                 if(inc_8_time>=0xfe)
  268.                                         {
  269.                                         stater=3;
  270.                                         flag2|=0x40;
  271.                                         cant_5s=0;
  272.                                         }
  273.                         break;
  274.                 case 2:
  275.                         if(i==0xf0)
  276.                                 {
  277.                                 flag2|=0x20;
  278.                                 stater=0;
  279.                                 inc_8_time=0;
  280.                                 P_INT_KEY_Clear=0xff;
  281.                                 P_INT_Ctrl2|=D_KeyIntEn;
  282.                                 flag4&=0xfd;
  283.                                 }
  284.                         else stater=1;
  285.                         break;
  286.                 case 3:
  287.                         if(i==0xf0)stater=4;
  288.                         else inc_8_time++;
  289.                         break;
  290.                 case 4:
  291.                         if(i==0xf0)
  292.                                 {
  293.                                 P_INT_KEY_Clear=0xff;
  294.                                 P_INT_Ctrl2|=D_KeyIntEn;
  295.                                 flag4&=0xfd;
  296.                                 flag2&=0xbf;
  297.                                 inc_8_time=0;
  298.                                 stater=0;
  299.                                 }
  300.                         else stater=3;
  301.                         break;
  302.                 }
  303. }

  305. int main(void)
  306. {
  307.         display_buf=&p1;
  308.         ow61_init();
  309.          clrr_dis_ram();
  310.          rfc_start();
  311.          while(second<3);
  312.          second=0;
  313.          dark_pres_unit();
  314.          dark_spend_unit();
  315.          *(display_buf+4+6)&=0xfb;//p1
  316.          *(display_buf+4)&=0x7f;//data
  317.          if(key_data==0x90)flag1|=0x02;
  318.          flag2&=0x9f;
  319.         while(1)
  320.                 {
  321.                 weath_read();
  322.                 read_temp_hum_1();
  323.                 read_temp_hum_2();
  324.                 read_comp_data();
  325.                 key_fun();
  326.                 coter_20second();
  327.                 disp_time();
  328.                 disp_temp();
  329.                 disp_press();
  330.                 disp_anlg();
  331.                 disp_weath();
  332.                 if(flag6&0x01)
  333.                         {
  334.                         spend_unit();flag5=flag5&0xfe;
  335.                         }
  336.                 if(!(flag3&0x80)&&!(flag4&0x02)&&!(comp_init_flag&0x10))
  337.                         P_TIMER_TimeBase_Ctrl2&=~D_128HzEn;
  338.                 if(!(flag3&0x80))
  339.                         {
  340.                         P_CLK_PLL_Ctrl&=0xcf;
  341.                         P_SLP_Ctrl=0xa5;
  342.                         P_CLK_PLL_Ctrl|=0x30;
  343.                         }
  344.                 else P_CLK_PLL_Ctrl|=0x30;
  345.                 //rfc_start();
  346.                 }
  347. }

  349. #pragma        codesec                ROM_keyscan_NBank0
  350. void coter_20second()
  351. {
  352.         if((cant_20s==40)&&((key_stater==1)||(key_stater==2)))
  353.                 {
  354.                 spend_danwei=0;
  355.                 key_stater=0;
  356.                 time_display_mode=0;
  357.                 flag4|=0xf8;
  358.                 time_display_mode=0;
  359.                 pres_disp_mode=0;
  360.                 press_unit();
  361.                 dark_spend_unit();
  362.                 }
  363.         if(cant_10s==10)
  364.                 {
  365.                 P_IO_PortD_Data=P_IO_PortD_Buffer&0xf7;
  366.                 }
  367.         if(cant_30s>33)
  368.                 {
  369.                 cant_30s=0;
  370.                 rfc_start();
  371.                 }
  372.         if((flag1&0x02)&&(cant_3s>3))
  373.                 {
  374.                 flag1|=0x10;
  375.                 cant_3s=0;
  376.                 }
  377.        
  378. }

  380. const unsigned char dis_data_tabl1[]=
  381. {
  382.                          0X3F,//0
  383.                          0X06,// 1
  384.                          0X5B,// 2
  385.                          0X4F,// 3
  386.                          0X66,// 4
  387.                          0X6D,//5
  388.                          0X7D,//6
  389.                          0X07,//7
  390.                          0X7F,//8
  391.                          0X6F,//9
  392.                          0X00,//DARK 10
  393.                          0x40,//- 11
  394.                          0x76,//H 12
  395.                          0x50,//r 13
  396.                          0x6e,//y 14
  397.                          0X79,//E 15
  398.                          0X36,//W 16
  399.                          0X09,//S 17
  400.                          0X36,//N 18
  401.                          0x39,//c 19
  402.                          0x71,//F 20
  403.                          0x63,//o 21
  404.                          0x37,//n 22
  405.                          0x38,//L 23
  406.                          
  407. };
  408. const unsigned char dis_data_tabl2[]=
  409. {
  410.                          0X00,//0
  411.                          0X00,// 1
  412.                          0X01,// 2
  413.                          0X01,// 3
  414.                          0X01,// 4
  415.                          0X01,//5
  416.                          0X01,//6
  417.                          0X00,//7
  418.                          0X01,//8
  419.                          0X01,//9
  420.                          0X00,//DARK
  421.                          0x01,//-
  422.                          0x01,//H
  423.                          0x01,//r
  424.                          0x01,//y
  425.                          0x00,//E
  426.                          0x0c,//w
  427.                          0x06,//s
  428.                          0x06,//N
  429. };
  430. const unsigned char weath_buf[]=
  431. {
  432.         0x02,0x04,0x08,0x01
  433. };

  435. cood_char di_1ge_8[]=
  436. {
  437.         0x4000+1,
  438.         0x4006+1,
  439.         0x400c+1,
  440.         0x8012+1,
  441.         0x010c,
  442.         0x8000+1,//dark
  443.         0x800c+1
  444. };
  445. cood_char di_2ge_8[]=
  446. {
  447.         0x0100+4,//a
  448.         0x0200+4,//b
  449.         0x020c+4,//c
  450.         0x0112+4,//d
  451.         0x010c+4,//e
  452.         0x0106+4,//f
  453.         0x0206+4//g
  454. };
  455. cood_char di_3ge_8[]=
  456. {
  457.         0x0800+4,//a
  458.         0x1000+4,//b
  459.         0x100c+4,//c
  460.         0x0812+4,//d
  461.         0x080c+4,//e
  462.         0x0806+4,//f
  463.         0x1006+4//g
  464. };
  465. cood_char di_4ge_8[]=
  466. {
  467.         0x2000+4,//a
  468.         0x4000+4,//b
  469.         0x400c+4,//c
  470.         0x2012+4,//d
  471.         0x200c+4,//e
  472.         0x2006+4,//f
  473.         0x4006+4//g
  474. };

  476. cood_char di_5ge_8[]=
  477. {
  478.         0x0200+3,//a
  479.         0x0206+3,//b
  480.         0x0212+3,//c
  481.         0x010c+3,//d
  482.         0x0106+3,//e
  483.         0x0100+3,//f
  484.         0x020c+3//g
  485. };
  486. cood_char di_6ge_8[]=
  487. {
  488.         0x0400+3,//a
  489.         0x0800+3,//b
  490.         0x080c+3,//c
  491.         0x0412+3,//d
  492.         0x040c+3,//e
  493.         0x0406+3,//f
  494.         0x0806+3//g
  495. };
  496. cood_char di_7ge_8[]=
  497. {
  498.         0x4012+1,//a
  499.         0x0118+4,//b
  500.         0x011e+4,//c
  501.         0x401e+1,//d
  502.         0x801E+1,//e
  503.         0x8018+1,//f
  504.         0x4018+1//g
  505. };
  506. cood_char di_8ge_8[]=
  507. {
  508.         0x040c+4,//a
  509.         0x0412+4,//b
  510.         0x0418+4,//c
  511.         0x041e+4,//d
  512.         0x021e+4,//e
  513.         0x0212+4,//f
  514.         0x0218+4//g
  515. };
  516. cood_char di_9ge_8[]=
  517. {
  518.         0x1012+4,//a
  519.         0x2018+4,//b
  520.         0x201e+4,//c
  521.         0x101e+4,//d
  522.         0x081E+4,//e
  523.         0x0818+4,//f
  524.         0x1018+4//g
  525. };
  526. cood_char di_10ge_8[]=
  527. {
  528.         0x800c+4,//a
  529.         0x0112+3,//b
  530.         0x011e+3,//c
  531.         0x801e+4,//d
  532.         0x8018+4,//e
  533.         0x8012+4,//f
  534.         0x0118+3//g
  535. };
  536. cood_char di_11ge_8[]=
  537. {
  538.         0x0418+3,//a
  539.         0x0812+3,//b
  540.         0x081e+3,//c
  541.         0x021e+3,//d
  542.         0x0218+3,//e
  543.         0x041e+3,//f
  544.         0x0818+3//g
  545. };
  546. cood_char di_15ge_8[]=
  547. {
  548.         0x081e+2,//a
  549.         0x0418+2,//b
  550.         0x0412+2,//c
  551.         0x0812+2,//d
  552.         0x1012+2,//e
  553.         0x1018+2,//f
  554.         0x0818+2//g
  555. };
  556. cood_char di_16ge_8[]=
  557. {
  558.         0x021e+2,//a
  559.         0x011e+2,//b
  560.         0x0112+2,//c
  561.         0x020c+2,//d
  562.         0x0212+2,//e
  563.         0x0218+2,//f
  564.         0x0118+2//g
  565. };
  566. cood_char di_17ge_8[]=
  567. {
  568.         0x801e+3,//a
  569.         0x4018+3,//b
  570.         0x400c+3,//c
  571.         0x800c+3,//d
  572.         0x8012+3,//e
  573.         0x8018+3,//f
  574.         0x4012+3//g
  575. };
  576. cood_char di_18ge_8[]=
  577. {
  578.         0x100c+1,//a
  579.         0x0806+1,//b
  580.         0x0800+1,//c
  581.         0x1000+1,//d
  582.         0x2000+1,//e
  583.         0x2006+1,//f
  584.         0x1006+1//g
  585. };
  586. cood_char di_19ge_8[]=
  587. {
  588.         0x020c+1,//a
  589.         0x0106+1,//b
  590.         0x0100+1,//c
  591.         0x0200+1,//d
  592.         0x0400+1,//e
  593.         0x0406+1,//f
  594.         0x0206+1//g
  595. };
  596. cood_char di_20ge_8[]=
  597. {
  598.         0x400c+2,//a
  599.         0x2006+2,//b
  600.         0x2000+2,//c
  601.         0x4000+2,//d
  602.         0x8000+2,//e
  603.         0x8006+2,//f
  604.         0x4006+2//g
  605. };
  606. cood_char di_21ge_8[]=
  607. {
  608.         0x080c+2,//a
  609.         0x040c+2,//b
  610.         0x0406+2,//c
  611.         0x0800+2,//d
  612.         0x1006+2,//e
  613.         0x100c+2,//f
  614.         0x0806+2//g
  615. };
  616. cood_char di_22ge_8[]=
  617. {
  618.         0x010c+2,//a
  619.         0x8006+3,//b
  620.         0x8000+3,//c
  621.         0x0100+2,//d
  622.         0x0200+2,//e
  623.         0x0206+2,//f
  624.         0x0106+2//g
  625. };
  626. cood_char di_12ge_8_1[]=
  627. {
  628.         0x201e+1,//a
  629.         0x081e+1,//b
  630.         0x080c+1,//c
  631.         0x200c+1,//d
  632.         0x2012+1,//e
  633.         0x2018+1,//f
  634.         0x1018+1//g
  635. };
  636. cood_char di_12ge_8_2[]=
  637. {
  638.         0x0818+1,//H
  639.         0x101e+1,//I
  640.         0x0812+1,//L
  641.         0x1012+1,//N
  642.         0x8000+1,//dark
  643.         0x8000+1,//dark
  644.         0x8000+1,//dark
  645. };
  646. cood_char di_14ge_8_1[]=
  647. {
  648.         0x801e+2,//a
  649.         0x201e+2,//b
  650.         0x200c+2,//c
  651.         0x800c+2,//d
  652.         0x8012+2,//e
  653.         0x8018+2,//f
  654.         0x4018+2//g
  655. };
  656. cood_char di_14ge_8_2[]=
  657. {
  658.         0x2018+2,//H
  659.         0x401e+2,//I
  660.         0x2012+2,//L
  661.         0x4012+2,//N
  662.         0x8000+1,//dark
  663.         0x8000+1,//dark
  664.         0x8000+1,//dark
  665. };
  666. cood_char di_13ge_8_1[]=
  667. {
  668.         0x041e+1,//a
  669.         0x011e+1,//b
  670.         0x010c+1,//c
  671.         0x040c+1,//d
  672.         0x0412+1,//e
  673.         0x0418+1,//f
  674.         0x0218+1//g
  675. };
  676. cood_char di_13ge_8_2[]=
  677. {
  678.         0x0118+1,//H
  679.         0x021e+1,//I
  680.         0x0112+1,//L
  681.         0x0212+1,//N
  682.         0x8000+1,//dark
  683.         0x8000+1,//dark
  684.         0x8000+1,//dark
  685. };
  686. #if 1
  687. const float temp_table[]=
  688. {
  689.         262.70        ,
  690.         249.21        ,
  691.         238.49        ,
  692.         224.49        ,
  693.         213.16        ,
  694.         202.46        ,
  695.         192.36        ,
  696.         182.82        ,
  697.         173.80        ,
  698.         165.28        ,
  699.         157.22        ,
  700.         149.59        ,
  701.         142.37        ,
  702.         135.55        ,
  703.         129.08        ,
  704.         122.96        ,
  705.         117.16        ,
  706.         111.66        ,
  707.         108.45        ,
  708.         101.51        ,
  709.         96.83        ,
  710.         92.38        ,
  711.         88.18        ,
  712.         84.16        ,
  713.         80.36        ,
  714.         76.75        ,
  715.         73.32        ,
  716.         70.06        ,
  717.         66.96        ,
  718.         64.02        ,
  719.         61.22        ,
  720.         58.55        ,
  721.         56.02        ,
  722.         53.60        ,
  723.         51.31        ,
  724.         49.12        ,
  725.         47.04        ,
  726.         45.05        ,
  727.         43.16        ,
  728.         41.36        ,
  729.         39.64        ,
  730.         38.00        ,
  731.         36.44        ,
  732.         34.95        ,
  733.         33.52        ,
  734.         32.16        ,
  735.         30.87        ,
  736.         29.63        ,
  737.         28.44        ,
  738.         27.31        ,
  739.         26.23        ,
  740.         25.20        ,
  741.         24.21        ,
  742.         23.27        ,
  743.         22.27        ,
  744.         21.50        ,
  745.         20.68        ,
  746.         19.89        ,
  747.         19.13        ,
  748.         18.40        ,
  749.         17.71        ,//60
  750.         /*
  751.         8.22        ,
  752.         7.94        ,
  753.         7.67        ,
  754.         7.41        ,
  755.         7.16        ,
  756.         6.9513        ,
  757.         6.6837        ,
  758.         6.4068        ,
  759.         6.2483        ,
  760.         6.0397        ,
  761.         5.8407        ,
  762.         5.6492        ,
  763.         5.4646        ,
  764.         5.2888        ,
  765.         5.1155        ,
  766.         4.9504        ,
  767.         4.7913        ,
  768.         4.6379        ,
  769.         4.49        ,
  770.         4.3474        ,
  771.         4.2099        ,
  772.         4.0772        ,
  773.         3.9493        ,
  774.         3.8259        ,
  775.         3.7088        ,
  776.         3.5917        ,
  777.         3.4087        ,
  778.         3.3735        ,
  779.         3.2701        ,
  780.         */
  781. };
  782. #endif
  783. const float hum_table[]=
  784. {
  785.         4460.0,
  786.         1945.0,
  787.         895.8,
  788.         434.3,
  789.         221.1,
  790.         117.9,
  791.         65.63,
  792.         38.09,
  793.         23.00,
  794.         14.42,
  795.         9.363,
  796.         6.291,
  797.         4.366,
  798.         3.125,
  799.         2.303,
  800.         1.746
  801. };



  805. #if 1
  806. const unsigned char cAtanStep[19]=
  807. {
  808. 0x11,0x12,0x13,0x14,0x15,
  809. 0x16,0x17,0x18,0x19,0x1a,
  810. 0x1b,0x1c,0x1d,0x1e,0x1f,
  811. 0x20,0x21,0x22,0x23
  812. };

  814. const unsigned int iAtanPoint[19]=
  815. {

  817. 0x020C,0x0998,0x0d60,0x1057,0x12cd,
  818. 0x1508,0x1702,0x18ca,0x1a8c,0x1c2c,
  819. 0x1da6,0x1f12,0x206e,0x21b8,0x2258,
  820. 0x244d,0x2576,0x26a8,0x2710
  821. };

  823. const unsigned int iAtanAngle[19]=
  824. {
  825. 0x001e,0x008a,0x00bd,0x00e3,0x0101,
  826. 0x011b,0x0131,0x0144,0x0156,0x0166,
  827. 0x0174,0x0181,0x018d,0x0198,0x01a3,
  828. 0x01ad,0x01b6,0x01bf,0x01c2
  829. };

  831. #endif
  832. #if 1
  833. const unsigned int angle_buf[]=
  834. {
  835.         0x0057,0x00b0,0x010b,0x016b,0x01d2,0x0241,0x02bc,0x0347,0x03e7       
  836. };
  837. #endif
  838. void ow61_init(void)
  839. {
  840.         P_CLK_PLL_Ctrl=0x30;
  841.         P_IO_Ctrl1=D_ExtI2En;
  842.         P_IO_Ctrl2=0;
  843.         P_IO_RFC_Ctrl=0;
  844.         P_IO_LCDPORT_Ctrl=0x37;
  845.        
  846.         P_IO_PortA_Dir=0x0d;
  847.         P_IO_PortA_Attrib=0x02;//PA1为输入做外部中断口
  848.         P_IO_PortA_Data=0xf1;
  849.        
  850.         P_IO_PortB_Dir=0xff;
  851.         P_IO_PortB_Attrib=0x10;
  852.         P_IO_PortB_Data=0xff;
  853.         P_IO_PortD_Dir=0xc8;
  854.         P_IO_PortD_Attrib=0x20;
  855.         P_IO_PortD_Data=0xe8;
  856.         if(P_IO_PortD_Data&0x10)
  857.                 {
  858.                 flag4|=0x04;
  859.                 P_IO_PortD_Data|=0x10;
  860.                 }
  861.         else flag4&=~0x04;
  862.                

  864.        
  865.         P_IO_PortE_Dir=0x00;
  866.         P_IO_PortE_Attrib=0x00;
  867.         P_IO_PortE_Data=0x00;
  868.         flag5=P_IO_PortE_Data;
  869.         P_IO_PortE_Data=flag5;
  870.         //;==========================
  871.        
  872.         //=======================
  873.         P_LCD_BIAS_Ctrl=D_LCDBias3;
  874.         P_LCD_VLCD_Ctrl=0x0f;//1.5v
  875.         //P_LCD_VLCD_Ctrl=0x0e;//1.467v
  876.         //P_LCD_VLCD_Ctrl=0x0d;//1.433v
  877.         //P_LCD_VLCD_Ctrl=0x0c;//1.4v
  878.         //P_LCD_VLCD_Ctrl=0x0b;//1.367v
  879.         //P_LCD_VLCD_Ctrl=0x0a;//1.333v
  880.         P_LCD_PUMP_Ctrl=D_PumpEn+D_PumpClk4K;
  881.         P_LCD_Ctrl2=D_LCDAllOn;
  882.         P_LCD_Clock=0x19;
  883.         P_LCD_COM_Num=5;
  884.         P_LCD_SEG_Num=5;
  885.         P_IO_LCDPORT_Ctrl=D_ShiftSeg24+D_PEEn+D_PCEn+D_PDEn;
  886.         P_LCD_StartAddr_LB=0;
  887.         P_LCD_Ctrl1=D_LCDEn+D_DisplayOn;

  889.         P_IO_KeyChange_Ctrl1=0xf0;
  890.         //====================
  891.         //P_LCD_Ctrl2=0x20;all off
  892.         //P_LCD_Ctrl2=0x40;all on
  893.         P_LCD_Ctrl2=0x00;
  894.         //======================
  895.         //中断初始化
  896.         disable_interrupt();//禁止中断
  897.         P_INT_TBL_Clear=0;
  898.         P_INT_TBH_Clear=0;
  899.         P_INT_TM0_Clear=0;
  900.        
  901.         P_TIMER_TimeBase_Status=D_2Hz_Flag;//清除溢出标志
  902.         P_TIMER_TimeBase_Ctrl2=D_2HzEn+D_128HzEn;//使能2HZ中断
  903.         P_TIMER_TimeBase_Ctrl1=D_TBRST;
  904.         P_TIMER_TimeBase_Ctrl1=D_TBRUN;
  905.         P_INT_Ctrl2=D_TBLIntEn+D_TBHIntEn+D_KeyIntEn;//+D_CtsTM0IntEn;
  906.         P_INT_Ctrl1=D_TM0IntEn;
  907.         P_TIMER_Timer_Ctrl=D_TM1Clk32K;
  908.         /*
  909.         P_TIMER_EN=0;
  910.         P_TIMER_TM1Data_LB=(65536-4)%256;
  911.         P_TIMER_TM1Data_HB=(65536-4)/256;//4kHz
  912.         P_AUDIO_BZ_Ctrl=0x05;
  913.         P_TIMER_EN=D_TM1En;
  914.         */
  915.         //P_TIMER_TM1CntData_LB=(65536-8)%256;
  916.         //P_TIMER_TM1CntData_HB=(65536-8)/256;
  917.         P_CTS_Timer_Ctrl=D_CtsTM0ClkRFC2;
  918. //        P_TIMER_TM0Data_LB=(65536-2)%256;
  919. //        P_TIMER_TM0Data_HB=(65536-2)%256;
  920. //        P_TIMER_TM0CntData_LB=(65536-2)%256;
  921. //        P_TIMER_TM0CntData_HB=(65536-2)%256;
  922.         P_INT_KEY_Clear=0xff;
  923.        
  924.         //P_TIMER_EN=D_TM1En;
  925.         //P_AUDIO_BZ_Ctrl=0x85;//bzp tim1 on
  926.         enable_interrupt();//使能中断
  927.        
  928. }
  929. void delay(void)
  930. {
  931.         // unsigned char i;
  932.         //for(i=0;i<20;i++)
  933.                 {
  934.                 nop_instruction();
  935.                 nop_instruction();
  936.                 nop_instruction();
  937.                 }
  938. }


  941. void clr_press_sclk_pb7(void)
  942. {
  943.         P_IO_PortB_Data&=0x7f;
  944. }


  947. void set_press_sclk_pb7(void)
  948. {
  949.         P_IO_PortB_Data|=0x80;
  950. }


  953. void clr_press_sdo_pb6(void)
  954. {
  955.         P_IO_PortB_Data&=0xbf;
  956. }


  959. void set_press_sdo_pb6(void)
  960. {
  961.         P_IO_PortB_Data|=0x40;
  962. }


  965. void sdo_pb6_set_in(void)
  966. {
  967.         P_IO_PortB_Dir&=0xbf;
  968.         P_IO_PortB_Attrib|=0x40;
  969.         P_IO_PortB_Data|=0x40;
  970. }


  973. void sdo_pb6_set_out(void)
  974. {
  975.         P_IO_PortB_Dir|=0x40;
  976.         P_IO_PortB_Data|=0x40;
  977. }
  978. void i2c_press_start(void)
  979. {
  980.         sdo_pb6_set_out();
  981.         delay();
  982.         clr_press_sclk_pb7();
  983.         delay();
  984.         set_press_sdo_pb6();
  985.         delay();
  986.         set_press_sclk_pb7();
  987.         delay();
  988.         clr_press_sdo_pb6();
  989.         delay();
  990.         clr_press_sclk_pb7();
  991.                
  992. }
  993. void i2c_press_stop(void)
  994. {
  995.         sdo_pb6_set_out();
  996.         clr_press_sdo_pb6();
  997.         delay();
  998.         set_press_sclk_pb7();
  999.         delay();
  1000.         set_press_sdo_pb6();
  1001. }
  1002. unsigned char i2c_press_wait_ack(void)
  1003. {
  1004.          unsigned char wr0;
  1005.         sdo_pb6_set_in();
  1006.         set_press_sclk_pb7();
  1007.         delay();
  1008.         wr0=P_IO_PortB_Data;
  1009.         clr_press_sclk_pb7();
  1010.         delay();
  1011.         return wr0;
  1012. }
  1013. void i2c_press_send_ack(void)
  1014. {
  1015.         sdo_pb6_set_out();
  1016.         delay();
  1017.         clr_press_sdo_pb6();
  1018.         delay();
  1019.         set_press_sclk_pb7();
  1020.         delay();
  1021.         clr_press_sclk_pb7();
  1022.         delay();
  1023. }
  1024. void i2c_press_no_ack(void)
  1025. {
  1026.         sdo_pb6_set_out();
  1027.         delay();
  1028.         set_press_sdo_pb6();
  1029.         delay();
  1030.         set_press_sclk_pb7();
  1031.         delay();
  1032.         clr_press_sclk_pb7();
  1033.         delay();
  1034. }
  1035. void i2c_press_send_8bit( unsigned char data1)
  1036. {
  1037.          unsigned data_buf,i;
  1038.         data_buf=data1;
  1039.         sdo_pb6_set_out();
  1040.         for(i=0;i<8;i++)
  1041.                 {
  1042.                 if(data_buf&0x80)set_press_sdo_pb6();
  1043.                 else clr_press_sdo_pb6();
  1044.                 set_press_sclk_pb7();
  1045.                 delay();
  1046.                 clr_press_sclk_pb7();
  1047.                 delay();
  1048.                 data_buf<<=1;
  1049.                 }
  1050. }
  1051. void i2c_press_read_8bit(void)
  1052. {
  1053.          unsigned char i;
  1054.         sdo_pb6_set_in();
  1055.         for(i=0;i<8;i++)
  1056.                 {
  1057.                         press_data_buf<<=1;
  1058.                         set_press_sclk_pb7();
  1059.                         delay();
  1060.                         if(P_IO_PortB_Buffer&0x40)press_data_buf=press_data_buf|0x00000001;
  1061.                         else press_data_buf=press_data_buf&0xfffffffe;
  1062.                         clr_press_sclk_pb7();
  1063.                         delay();       
  1064.                 }
  1065. }
  1066. #if 0
  1067. void weath(void)
  1068. {
  1069.          unsigned char buf1;
  1070.         pointer1=&wr4;
  1071.         wr4=press_save_data-press_data_buf;
  1072.         buf1=*(pointer1+3);
  1073.         if(buf1&0x80)wr4=~wr4;//取最高8位
  1074.         wr4+=1;
  1075.         if(!weath_stater)//判断是否是晴天
  1076.                 {
  1077.                 if(buf1&0x80)press_save_data=press_data_buf;
  1078.                 else
  1079.                         {
  1080.                         if((wr4>300)&&(wr0<600))flag2=0x04;//阴天
  1081.                         else if(wr4>=600){flag2=0x08;press_save_data=press_data_buf;}//小雨
  1082.                         }
  1083.                 }
  1084.         else
  1085.                 {
  1086.                 if(buf1&0x80)//判断气压是增还是减
  1087.                         {
  1088.                         if((wr4>200)&&(wr0<500))flag2=0x02;//半晴天
  1089.                         else if(wr4>=500)flag2=0x01;//晴天
  1090.                         }
  1091.                 else
  1092.                         {
  1093.                         if(flag2&0x10);//press_save_data=press_data_buf;
  1094.                         else if(flag2&0x08)
  1095.                                 {
  1096.                                         if(wr4>=200)flag2=0x10;//大雨
  1097.                                 }
  1098.                         else {if(wr4>100)flag2=0x08;}//小雨
  1099.                         press_save_data=press_data_buf;
  1100.                         }
  1101.                 }
  1102. }
  1103. #endif
  1104. void weath(void)
  1105. {
  1106.        
  1107.         if(flag0&0x4)
  1108.         {
  1109.         if(canat_60_minute<60)return;
  1110.         flag4|=0x10;
  1111.         canat_60_minute=0;
  1112.         wr4=press_save_data-press_data_buf;
  1113.         switch(weath_stater)
  1114.                 {
  1115.                 case 0:
  1116.                         if(wr4<=0)press_save_data=press_data_buf;
  1117.                         else if(wr4>=60)
  1118.                                 {
  1119.                                 press_save_data=press_data_buf;
  1120.                                 weath_stater=3;
  1121.                                 }
  1122.                         else if(wr4>=30)
  1123.                                 {
  1124.                                 weath_stater=2;
  1125.                                 }
  1126.                         break;
  1127.                 case 1:
  1128.                         if(wr4<=-50)
  1129.                                 {
  1130.                                 press_save_data=press_data_buf;
  1131.                                 weath_stater=0;
  1132.                                 }
  1133.                         else if(wr4>=10)
  1134.                                 {
  1135.                                 press_save_data=press_data_buf;
  1136.                                 weath_stater=3;       
  1137.                                 }
  1138.                         break;
  1139.                 case 2:
  1140.                         if(wr4<=-50)
  1141.                                 {
  1142.                                 press_save_data=press_data_buf;
  1143.                                 weath_stater=0;
  1144.                                 }
  1145.                         else if(wr4<=-20)weath_stater=1;
  1146.                         else if(wr4>=10)
  1147.                                 {
  1148.                                 press_save_data=press_data_buf;
  1149.                                 weath_stater=3;       
  1150.                                 }
  1151.                         break;
  1152.                 case 3:
  1153.                         if(wr4<=-50)
  1154.                                 {
  1155.                                 press_save_data=press_data_buf;
  1156.                                 weath_stater=0;
  1157.                                 }
  1158.                         else if(wr4<=-20)weath_stater=1;
  1159.                         else if(wr4>0)press_save_data=press_data_buf;
  1160.                         break;
  1161.                 }
  1162.         }
  1163.         else
  1164.                 {
  1165.                         press_save_data=press_data_buf-30;
  1166.                         flag0|=0x4;
  1167.                 }
  1168. }

  1170. void weath_read(void)
  1171. {
  1172.         unsigned char wr0;
  1173.         if(!(flag1&0x10))return;
  1174.                 i2c_press_start();
  1175.                 i2c_press_send_8bit(0xd8);
  1176.                 wr0=i2c_press_wait_ack();       
  1177.                 if(wr0&0x40){i2c_press_stop();return;}
  1178.                 i2c_press_send_8bit(0x30);
  1179.                 wr0=i2c_press_wait_ack();       
  1180.                 if(wr0&0x40){i2c_press_stop();return;}
  1181.                 i2c_press_send_8bit(0x0a);
  1182.                 wr0=i2c_press_wait_ack();       
  1183.                 if(wr0&0x40){i2c_press_stop();return;}
  1184.                 i2c_press_stop();
  1185.                
  1186.                 i2c_press_start();
  1187.                 i2c_press_send_8bit(0xd8);
  1188.                 wr0=i2c_press_wait_ack();       
  1189.                 if(wr0&0x40){i2c_press_stop();return;}
  1190.                 i2c_press_send_8bit(0x06);
  1191.                 wr0=i2c_press_wait_ack();       
  1192.                 if(wr0&0x40){i2c_press_stop();return;}
  1193.                 i2c_press_start();
  1194.                 i2c_press_send_8bit(0xd9);
  1195.                 wr0=i2c_press_wait_ack();       
  1196.                 if(wr0&0x40){i2c_press_stop();return;}
  1197.                 press_data_buf=0;
  1198.                 //i2c_press_start();
  1199.                 i2c_press_read_8bit();
  1200.                 i2c_press_send_ack();
  1201.                 i2c_press_read_8bit();
  1202.                 i2c_press_send_ack();
  1203.                 i2c_press_read_8bit();
  1204.                 i2c_press_no_ack();
  1205.                 i2c_press_stop();
  1206.                 press_data_buf=press_data_buf>>6;//unit pa
  1207.                 press_data_buf=press_data_buf/100*10;
  1208.                 if(!(flag0&0x4))
  1209.                         {
  1210.                         high_value=10120-press_data_buf;
  1211.                         }
  1212.                 //wr1=powf((float)press_data_buf/(float)press_data,0.190263);
  1213.                 //wr1=1-wr1;
  1214.                 //wr1=wr1*44330.77;
  1215.                 //high_value=wr1;
  1216.                 //high_value+=save_shift_high;
  1217.                 //if(high_value>9999)high_value=9999;
  1218.                 //else if(high_value<0)high_value=0;
  1219.                
  1220.                 weath();
  1221.                 press_unit();
  1222.                 flag1&=0xef;
  1223. }
  1224. void clrr_dis_ram(void)
  1225. {
  1226.         unsigned char i;
  1227.         for(i=0;i<0xff;i++)
  1228.                 {
  1229.                 *(display_buf+i)=0x00;
  1230.                 }
  1231.         for(i=0;i<0xff;i++)
  1232.                 {
  1233.                 *(display_buf+i)=0xFF;
  1234.                 }
  1235. }
  1236. #if 1
  1237. void clr_temp_sclk_pd7(void)
  1238. {
  1239.         P_IO_PortD_Data&=0x7f;
  1240. }
  1241. void set_temp_sclk_pd7(void)
  1242. {
  1243.         P_IO_PortD_Data|=0x80;
  1244. }
  1245. void clr_temp_sdo_pd6(void)
  1246. {
  1247.         P_IO_PortD_Data&=0xbf;
  1248. }
  1249. void set_temp_sdo_pd6(void)
  1250. {
  1251.         P_IO_PortD_Data|=0x40;
  1252. }
  1253. void sdo_pd6_set_in(void)
  1254. {
  1255.         P_IO_PortD_Dir&=0xbf;
  1256.         P_IO_PortD_Attrib|=0x40;
  1257.         P_IO_PortD_Data|=0x40;
  1258. }
  1259. void sdo_pd6_set_out(void)
  1260. {
  1261.         P_IO_PortD_Dir|=0x40;
  1262.         P_IO_PortD_Data|=0x40;
  1263. }
  1264. void teamp_start(void)
  1265. {
  1266.         sdo_pd6_set_out();
  1267.         set_temp_sdo_pd6();
  1268.         set_temp_sclk_pd7();
  1269.         delay();
  1270.         clr_temp_sdo_pd6();
  1271.         clr_temp_sclk_pd7();
  1272.         delay();
  1273. }
  1274. void temp_stop(void)
  1275. {
  1276.         sdo_pd6_set_out();
  1277.         clr_temp_sdo_pd6();
  1278.         set_temp_sclk_pd7();
  1279.         delay();
  1280.         set_temp_sdo_pd6();
  1281.         delay();
  1282. }
  1283. void temp_send_ack(void)
  1284. {
  1285.         sdo_pd6_set_out();
  1286.         clr_temp_sdo_pd6();
  1287.         set_temp_sclk_pd7();
  1288.         delay();
  1289.         clr_temp_sclk_pd7();
  1290.         delay();
  1291. }
  1292. void temp_no_ack(void)
  1293. {
  1294.         sdo_pd6_set_out();
  1295.         set_temp_sdo_pd6();
  1296.         set_temp_sclk_pd7();
  1297.         delay();
  1298.         clr_temp_sclk_pd7();
  1299.         delay();
  1300. }
  1301. void temp_send_8bit(unsigned char data)
  1302. {
  1303.         unsigned char i,data_buf=0;
  1304.         sdo_pd6_set_out();
  1305.         data_buf=data;
  1306.         for(i=0;i<8;i++)
  1307.                 {
  1308.                 if(data_buf&0x80)sdo_pd6_set_out();
  1309.                 else clr_temp_sdo_pd6();
  1310.                 data_buf<<=1;
  1311.                 set_temp_sclk_pd7();
  1312.                 delay();
  1313.                 clr_temp_sclk_pd7();
  1314.                 delay();
  1315.                 }
  1316.         sdo_pd6_set_in();
  1317.         set_temp_sclk_pd7();
  1318.         delay();
  1319.         if(P_IO_PortD_Data&0x40)flag0|=0x20;
  1320.         else flag0&=0xdf;
  1321.         clr_temp_sclk_pd7();
  1322. }
  1323. void temp_read(void)
  1324. {
  1325.         unsigned char i;
  1326.         sdo_pd6_set_in();
  1327.         for(i=0;i<8;i++)
  1328.                 {
  1329.                         wr6<<=1;
  1330.                         set_temp_sclk_pd7();
  1331.                         delay();
  1332.                         if(P_IO_PortD_Data&0x40)wr6|=0x0001;
  1333.                         else wr6=wr6&0xfffe;
  1334.                         clr_temp_sclk_pd7();
  1335.                         delay();       
  1336.                 }       
  1337. }
  1338. void read_temp_hum_2(void)
  1339. {
  1340.         static unsigned char stater=0;
  1341.         if(!(flag3&0x80))return;
  1342.         if(!(flag4&0x04))return;
  1343.         switch(stater)
  1344.                 {
  1345.                 case 0:       
  1346.                 teamp_start();
  1347.                 temp_send_8bit(0x80);
  1348.                 temp_send_8bit(0xe5);
  1349.                 temp_test_time=0;
  1350.                 stater++;
  1351.                 break;
  1352.                 case 1:
  1353.                         if(temp_test_time>2)stater++;
  1354.                         break;
  1355.                 case 2:
  1356.                         teamp_start();
  1357.                         temp_send_8bit(0x81);
  1358.                         temp_read();
  1359.                         temp_send_ack();
  1360.                         temp_read();
  1361.                         temp_no_ack();
  1362.                         temp_stop();
  1363.                         if(!(flag0&0x20))
  1364.                                 {
  1365.                                 in_hum=(int)(125.0*wr6/65536.0-6.0);
  1366.                                 stater++;
  1367.                                 }
  1368.                         else stater=0;
  1369.                         break;
  1370.                 case 3:
  1371.                         teamp_start();
  1372.                         temp_send_8bit(0x80);
  1373.                         temp_send_8bit(0xe0);
  1374.                         teamp_start();
  1375.                         temp_send_8bit(0x81);
  1376.                         temp_read();
  1377.                         temp_send_ack();
  1378.                         temp_read();
  1379.                         temp_no_ack();
  1380.                         temp_stop();
  1381.                         if(!(flag0&0x20))
  1382.                                 {
  1383.                                 in_temp=(int)(1757.2*wr6/65536-468.5);
  1384.                                 in_temp_f=(int)(1757.2*wr6/117964.8/*65536*1.8=117964.8*/-843.3/*468.5*1.8=843.3*/+320);
  1385.                                 }
  1386.                         stater=0;
  1387.                         flag3&=0x7f;
  1388.                         flag4|=0x40;
  1389.                         break;
  1390.                 }
  1391. }
  1392. #endif
  1393. unsigned char Rfc_SeekTab(float res,float *tab_addr)
  1394. {
  1395.         unsigned char x,y,z;
  1396.         unsigned long res_m;

  1398.         //初始化"实测电阻值"在表中的范围
  1399.         //起点
  1400.         x=0;
  1401.         //终点
  1402.         z=60;

  1404.         //递归缩小包围圈,找到"实测电阻值"在表中的具体位置
  1405.         while((x+2) <= z)
  1406.         {
  1407.                 //取表格中间的数据
  1408.                 y = (x+z)/2;
  1409.                 res_m = tab_addr[y];

  1411.                 //缩小实测电阻值所在表格的范围
  1412.                 if(res > res_m)
  1413.                 {
  1414.                         z = y;
  1415.                 }
  1416.                 else
  1417.                 {
  1418.                         x = y;
  1419.                 }
  1420.         }

  1422.         return x;
  1423. }
  1424. void cal_temp(unsigned int d1)
  1425. {
  1426.         wr0=rfc_ref;
  1427.         wr0=wr0*50.0/d1;
  1428.         wr0=wr0-50;
  1429.         if(wr0<1000)
  1430.         wr0=wr0*1000.0/(1000.0-wr0);
  1431.         else wr0=4460;
  1432. }

  1434. void read_temp_hum_1(void)
  1435. {
  1436.         unsigned char i;
  1437.         if(!(flag4&0x01))return;
  1438.         cal_temp(rfc_sen1);
  1439.         i=Rfc_SeekTab(wr0,temp_table);
  1440.         if(i==0)wr0=-10;
  1441.         else if(wr0>=temp_table[i])
  1442.                 {
  1443.                 wr0=(temp_table[i-1]-wr0)/(temp_table[i-1]-temp_table[i]);
  1444.                 wr0=(float)i-1+wr0-10.0;
  1445.                 }
  1446.         else
  1447.                 {
  1448.                 wr0=(temp_table[i]-wr0)/(temp_table[i]-temp_table[i+1]);
  1449.                 wr0=(float)i+wr0-10.0;
  1450.                 }
  1451.         wr1=wr0;
  1452.         in_temp=(int)(wr0*10.0);
  1453.         in_temp_f=(wr0*1.8+32)*10.0;
  1454.         cal_temp(rfc_sen2);
  1455.         i=0;
  1456.         for(;;)
  1457.                 {
  1458.                 if(wr0>=hum_table[i])break;
  1459.                 i++;
  1460.                 if(i==15)break;
  1461.                 }
  1462.         if(i==0)in_hum=20;
  1463.         else if(i==15)in_hum=99;
  1464.         else
  1465.                 {
  1466.                 wr0=(wr0-hum_table[i])/(hum_table[i-1]-hum_table[i])*5;
  1467.                 in_hum=(int)(20.0+(float)i*5.0-wr0);
  1468.                 }
  1469.         wr1=(wr1-25)*0.5;
  1470.         in_hum=(int)(in_hum-wr1);
  1471.         flag4&=0xfe;
  1472.         flag4|=0x40;
  1473. }

  1475. #pragma        codesec                ROM_keyscan_NBank1
  1476. #if 0
  1477. void heat_index(void)
  1478. {
  1479.         wr0=in_temp*1.8+32;
  1480.         wr3=-42.379+2.04901523*wr0+10.14333172*in_hum;
  1481.         wr3=wr3-0.22475541*wr0*in_hum;
  1482.         wr3=wr3+0.00122874*wr0*wr0*in_hum;
  1483.         wr3=wr3+0.00085282*in_hum*in_hum*wr0;
  1484.         wr3=wr3-0.00000199*in_hum*in_hum*wr0*wr0;
  1485.         if(in_hum<13)
  1486.                 {
  1487.                 //wr3=wr3-sqrtf((17-fabsf(95-wr0))/17.0)*(13-in_hum)/4.0;       
  1488.                 wr3=wr3-powf((17-fabsf(95-wr0))/17.0,0.5)*(13-in_hum)/4.0;       
  1489.                 }
  1490.         else if(((in_hum>85)&&(80<wr0<87)))
  1491.                 {
  1492.                 wr3=wr3+(in_hum-85)/10.0*(87-wr0);
  1493.                 }
  1494.         heat_buf=wr3;
  1495.         wr3=35.74+0.6215*wr0-35.75*powf(spend,0.16) + 0.4275*wr0*powf(spend,0.16);
  1496.         chilltemp=wr3;
  1497. }
  1498. #endif
  1499. void set_comp_sclk_high(void)
  1500. {
  1501.         P_IO_PortB_Data|=0x20;       
  1502. }
  1503. void set_comp_sclk_low(void)
  1504. {
  1505.         P_IO_PortB_Data&=0xdf;       
  1506. }
  1507. void set_comp_sda_high(void)
  1508. {
  1509.         P_IO_PortB_Data|=0x10;       
  1510. }
  1511. void set_comp_sda_low(void)
  1512. {
  1513.         P_IO_PortB_Data&=0xef;       
  1514. }
  1515. void set_comp_sda_in(void)
  1516. {
  1517.         P_IO_PortB_Dir&=0xef;
  1518.         //P_IO_PortB_Attrib|=0x10;
  1519.         //P_IO_PortB_Data|=0x10;
  1520. }
  1521. void set_comp_sda_out(void)
  1522. {
  1523.         P_IO_PortB_Dir|=0x10;
  1524.         //P_IO_PortB_Attrib&=0xef;
  1525.         //P_IO_PortB_Data|=0x10;
  1526. }
  1527. void comp_start(void)
  1528. {
  1529.         //set_comp_sda_out();
  1530.         set_comp_sda_high();
  1531.         delay();
  1532.         set_comp_sclk_high();
  1533.         delay();
  1534.         set_comp_sda_low();
  1535.         delay();
  1536.         set_comp_sclk_low();
  1537.         delay();
  1538. }
  1539. void comp_stop(void)
  1540. {
  1541.         //set_comp_sda_out();
  1542.         set_comp_sclk_low();
  1543.         delay();
  1544.         set_comp_sda_low();
  1545.         delay();
  1546.         set_comp_sclk_high();
  1547.         delay();
  1548.         set_comp_sda_high();
  1549.         delay();
  1550.         set_comp_sclk_high();
  1551.         delay();
  1552. }
  1553. void comp_sed_ack(void)
  1554. {
  1555.         //set_comp_sda_out();
  1556.         set_comp_sda_low();
  1557.         set_comp_sclk_high();
  1558.         delay();
  1559.         delay();
  1560.         delay();
  1561.         set_comp_sclk_low();
  1562.         delay();
  1563. }
  1564. void comp_no_ack(void)
  1565. {
  1566.         //set_comp_sda_out();
  1567.         set_comp_sda_high();
  1568.         delay();
  1569.         set_comp_sclk_high();
  1570.         delay();
  1571.         delay();
  1572.         set_comp_sclk_low();
  1573.         delay();
  1574. }
  1575. void comp_send_8_bit(unsigned char send_data)
  1576. {
  1577.         unsigned char i,d;
  1578.         d=send_data;
  1579.         //set_comp_sda_out();
  1580.         for(i=0;i<8;i++)
  1581.                 {
  1582.                 if(d&0x80)set_comp_sda_high();
  1583.                 else set_comp_sda_low();
  1584.                 set_comp_sclk_high();
  1585.                 delay();
  1586.                 set_comp_sclk_low();
  1587.                 delay();
  1588.                 d<<=1;
  1589.                 }
  1590.         set_comp_sda_in();
  1591.         delay();
  1592.         set_comp_sclk_high();
  1593.         delay();       
  1594.         if(P_IO_PortB_Data&0x10)flag1|=0x40;
  1595.         else flag1&=0xbf;
  1596.         set_comp_sclk_low();
  1597.         delay();
  1598.         set_comp_sda_out();
  1599. }
  1600. unsigned char comp_read_8bit(void)
  1601. {
  1602.         unsigned char i=0,d=0;
  1603.         set_comp_sda_in();
  1604.         for(i=0;i<8;i++)
  1605.                 {
  1606.                 d<<=1;       
  1607.                 set_comp_sclk_high();
  1608.                 delay();
  1609.                 if(P_IO_PortB_Data&0x10)d|=0x01;
  1610.                 else d&=0xef;
  1611.                 set_comp_sclk_low();
  1612.                 delay();
  1613.                 }
  1614.         set_comp_sda_out();
  1615.         return d;
  1616. }
  1617. unsigned char read_stater(void)
  1618. {
  1619.         unsigned char return_data;
  1620.         comp_start();
  1621.         comp_send_8_bit(0x60);
  1622.         comp_send_8_bit(0x06);
  1623.         comp_start();
  1624.         comp_send_8_bit(0x61);
  1625.         if(flag1&0x40)return 0;
  1626.         return_data=comp_read_8bit();
  1627.         comp_no_ack();
  1628.         comp_stop();
  1629.         return return_data;
  1630. }
  1631. void rest_set(unsigned char dd)
  1632. {
  1633.         comp_start();
  1634.         comp_send_8_bit(0x60);
  1635.         comp_send_8_bit(0x07);
  1636.         comp_send_8_bit(dd);
  1637.         comp_stop();
  1638. }
  1639. void max_min_init(void)
  1640. {
  1641.         xmax=0x0000;
  1642.         xmin=0xffff;
  1643.         ymax=0;
  1644.         ymin=0xffff;
  1645.         xvalue_buf=0;
  1646.         yvalue_buf=0;
  1647. }
  1648. void read_data(void)
  1649. {
  1650.         unsigned char r_data;
  1651.         comp_start();
  1652.         comp_send_8_bit(0x60);
  1653.         comp_send_8_bit(0x00);
  1654.         comp_start();
  1655.         comp_send_8_bit(0x61);
  1656.         XRaw=comp_read_8bit();
  1657.         comp_sed_ack();
  1658.         r_data=comp_read_8bit();
  1659.         XRaw|=r_data<<8;
  1660.         //XRaw=r_data;
  1661.         comp_sed_ack();
  1662.         YRaw=comp_read_8bit();
  1663.         comp_sed_ack();
  1664.         r_data=comp_read_8bit();
  1665.         YRaw|=r_data<<8;
  1666.         //YRaw=r_data;
  1667.         comp_sed_ack();
  1668.         r_data=comp_read_8bit();
  1669.         comp_sed_ack();
  1670.         r_data=comp_read_8bit();
  1671.         comp_no_ack();
  1672.         comp_stop();
  1673. }
  1674.   unsigned  long int arcTan(unsigned long int lAcc);

  1676. /****************************************************
  1677. ****************************************************/

  1679. /***************************************************
  1680. ***************************************************/


  1683. /***************************************************
  1684. ***************************************************/

  1686. /******************************************************************************
  1687. ;---Function Description: compass processs
  1688. ******************************************************************************/
  1689. void cal_compass(void)
  1690. {
  1691.         unsigned long int X_raw, Y_raw;                // signed X & Y Raw data
  1692.         unsigned long int lAcc;
  1693.         int Vangle;

  1695.         if( XRaw > Xoffset )
  1696.                 X_raw = XRaw - Xoffset;
  1697.         else
  1698.                 X_raw = Xoffset - XRaw ;
  1699.         if( YRaw > Yoffset)
  1700.                 Y_raw = YRaw - Yoffset;
  1701.         else
  1702.                 Y_raw = Yoffset - YRaw ;
  1703.         if( Xsens > Ysens )
  1704.                 {
  1705.                 Y_raw*=Xsens;
  1706.                 Y_raw = Y_raw / Ysens; // perform gain matching
  1707.                 }
  1708.         else
  1709.                 {
  1710.                 X_raw*=Ysens;
  1711.                 X_raw = X_raw/ Xsens; // perform gain matching
  1712.                 }

  1714.         if( X_raw >= Y_raw)
  1715.         {
  1716.                 lAcc = Y_raw;
  1717.                 lAcc *= 1000;
  1718.                 lAcc /= X_raw;
  1719.                 lAcc /= 1;
  1720.                 lAcc = arcTan(lAcc);
  1721.                 Vangle = lAcc / 10;
  1722.         //        Vangle=arcTan(lAcc);
  1723.         }
  1724.         else
  1725.         {
  1726.                 lAcc = X_raw;
  1727.                 lAcc *= 1000;
  1728.                 lAcc = lAcc/Y_raw;
  1729.                 lAcc = arcTan(lAcc);
  1730.                 Vangle = 90 - (lAcc/10);
  1731.                 //Vangle=90-arcTan(lAcc);
  1732.         }
  1733.         #if 0
  1734.         if(XRaw>=Xoffset)
  1735.                 {
  1736.                 if(YRaw>=Yoffset)Vangle=Vangle;
  1737.                 else Vangle=180-Vangle;
  1738.                 }
  1739.         else
  1740.                 {
  1741.                 if(YRaw>=Yoffset)Vangle=360-Vangle;
  1742.                 else Vangle=180+Vangle;
  1743.                 }
  1744.         #endif
  1745.         #if 1
  1746.         if((XRaw > Xoffset) && (YRaw > Yoffset)) Vangle = Vangle; // quadrant +X, +Y (0 to 90)
  1747.         if((XRaw < Xoffset) && (YRaw > Yoffset)) Vangle = 180 - Vangle; // quadrant X, +y (91 to 180)
  1748.         else if((XRaw < Xoffset) && (YRaw < Yoffset)) Vangle = 180 + Vangle; // quadrant X, -Y (181 to 270)
  1749.         else if((XRaw > Xoffset) && (YRaw < Yoffset)) Vangle = 360 - Vangle; // quadrant +X, -Y (271 to 359)
  1750.         //Vangle-=180;
  1751. //        if(Vangle>=360)
  1752.         //        {
  1753.         //                Vangle -=360;
  1754.         //        }
  1755.         //else if(Vangle<0)
  1756.         //        {
  1757.         //                Vangle +=360;
  1758.         //        }
  1759.         #if 0
  1760.         if(XRaw == Xoffset)
  1761.         {
  1762.                 if(YRaw == Yoffset)
  1763.                         {
  1764.                                 Vangle = 0;
  1765.                         }
  1766.         else if(YRaw > Yoffset)
  1767.                         {
  1768.                                 Vangle = 90;
  1769.                         }
  1770.         else
  1771.                         {
  1772.                                 Vangle = 270;
  1773.                         }
  1774.         }
  1775.         if(YRaw == Yoffset)
  1776.         {
  1777.                 if(XRaw == Xoffset)
  1778.                         {
  1779.                         Vangle = 0;
  1780.                         }
  1781.         else if(XRaw > Xoffset)
  1782.                         {
  1783.                                 Vangle = 0;
  1784.                         }
  1785.         else
  1786.                         {
  1787.                                 Vangle = 180;
  1788.                         }
  1789.         }
  1790.         if(Vangle>=360)
  1791.                 {
  1792.                         Vangle -=360;
  1793.                 }
  1794.         else
  1795.                 {
  1796.                 if(Vangle <= 0)
  1797.                         {
  1798.                                 Vangle +=360;
  1799.                         }
  1800.                 if(Vangle == 360)
  1801.                         {
  1802.                                 Vangle = 0;
  1803.                         }
  1804.                 }
  1805.         #endif
  1806.         #if 0
  1807.         if(!((XRaw < Xoffset) && (YRaw < Yoffset)))
  1808.                 {
  1809.         if(Vangle < 360)
  1810.                 {
  1811.                         Vangle = 360 - Vangle;
  1812.                 }
  1813.         else
  1814.                 {
  1815.                         Vangle -= 360;
  1816.                 }
  1817.         Vangle += 270;
  1818.         if(Vangle >= 360)
  1819.                 {
  1820.                         Vangle -= 360;
  1821.                 }
  1822.                 }
  1823.         #endif
  1824.         //I2cAngleBuf[0] = (unsigned char)(Vangle & 0xff);
  1825.         //Vangle >>= 8;
  1826.         //I2cAngleBuf[1] = (unsigned char)(Vangle & 0xff);
  1827.         #endif
  1828.         angle=Vangle;
  1829.         flag4|=0x80;
  1830. }

  1832. /***************************************************
  1833. ***************************************************/
  1834. #if 1
  1835. unsigned long int arcTan(unsigned long int lAcc) // arc Tan function
  1836. {
  1837. char I;

  1839. lAcc *= 10;
  1840. if(lAcc>10000)
  1841. lAcc=10000;
  1842. for(I=0;I<19;I++)
  1843. {
  1844. if (lAcc <= iAtanPoint[I])
  1845.         {
  1846.                 if(I== 0)
  1847.                         {
  1848.                         lAcc /= cAtanStep[0];
  1849.                         }
  1850.                 else
  1851.                         {
  1852.                         lAcc -= iAtanPoint[I-1];
  1853.                         lAcc /= cAtanStep[I-1];
  1854.                         lAcc += iAtanAngle[I-1];
  1855.                         }
  1856.                         break;
  1857.          }
  1858. }
  1859. return(lAcc);
  1860. }
  1861. #endif
  1862. #if 0
  1863. unsigned char arcTan(unsigned long int lAcc)
  1864. {
  1865.         unsigned char i,j=0;
  1866.         for(i=0;i<9;i++)
  1867.                 {
  1868.                         if (lAcc <= angle_buf[i])
  1869.                         {
  1870.                                 if(i== 0)
  1871.                                         {
  1872.                                         j = 5-(angle_buf[i]-lAcc)*10/angle_buf[i]/10;
  1873.                                         }
  1874.                                 else
  1875.                                         {
  1876.                                         j = 5*i-(angle_buf[i]-lAcc)*10/(angle_buf[i]-angle_buf[i-1])/10;
  1877.                                         }
  1878.                                         break;
  1879.                          }
  1880.                 }
  1881.         if(i>=8)j=45;
  1882.         return j;
  1883. }
  1884. #endif
  1885. void test_comp()
  1886. {
  1887.         comp_start();
  1888.         comp_send_8_bit(0x60);
  1889.         comp_send_8_bit(0x07);
  1890.         comp_send_8_bit(0x01);
  1891.         comp_stop();
  1892. }
  1893. #if 0
  1894. void read_comp_data(void)
  1895. {
  1896.         unsigned char r_data;
  1897.         unsigned long int data_1;
  1898.         static unsigned char i;
  1899.         static unsigned char j=0;
  1900.         if(!(comp_init_flag&0x10))return;
  1901.         if(comp_init_flag&0x01)//init1
  1902.                 {
  1903.                         //if(axis_test_time<4)return;
  1904.                         axis_test_time=0;
  1905.                         comp_start();
  1906.                         comp_send_8_bit(0x60);
  1907.                         comp_send_8_bit(0x07);
  1908.                         comp_send_8_bit(0x80);
  1909.                         comp_stop();
  1910.                         comp_init_flag&=0xfe;
  1911.                         i=0;
  1912.                 }
  1913.         else if(comp_init_flag&0x02)//init2
  1914.                 {
  1915.                         if(axis_test_time<16)return;
  1916.                         axis_test_time=0;
  1917.                 //        comp_start();
  1918.                 //        comp_send_8_bit(0x60);
  1919.                 //comp_send_8_bit(0x08);
  1920.                 //        comp_send_8_bit(0x01);
  1921.                 //        comp_stop();
  1922.                         rest_set(0x23);
  1923.                         comp_init_flag&=0xfd;
  1924.                         i=0;
  1925.                         max_min_init();       
  1926.                         //test_comp();
  1927.                         j=0;
  1928.                 }
  1929.         else if(comp_init_flag&0x04)
  1930.                 {
  1931.                         r_data=read_stater();
  1932.                         if(r_data&0x01)
  1933.                                 {
  1934.                                 read_data();
  1935.                                 //test_comp();
  1936.                                 if(xmax<XRaw)
  1937.                                         {
  1938.                                         xmax=XRaw;
  1939.                                         //test11=YRaw;
  1940.                                         }
  1941.                                  if(xmin>XRaw)
  1942.                                          {
  1943.                                          xmin=XRaw;
  1944.                                         //test21=YRaw;
  1945.                                         }
  1946.                                 if(ymax<YRaw)
  1947.                                         {
  1948.                                         ymax=YRaw;
  1949.                                         //test31=XRaw;
  1950.                                         }
  1951.                                  if(ymin>YRaw)
  1952.                                          {ymin=YRaw;}//test41=XRaw;
  1953.                                 i++;
  1954.                                 if(i>=8)
  1955.                                         {
  1956.                                         i=0;
  1957.                                         compass_data++;
  1958.                                         j++;
  1959.                                         }
  1960.                                 if(j>=40)comp_init_flag&=~0x04;
  1961.                                 }
  1962.                 }
  1963.         else if(comp_init_flag&0x08)
  1964.                 {
  1965.                                 i=0;
  1966.                                 data_1=xmax;
  1967.                                 data_1+=xmin;
  1968.                                 Xoffset = data_1/2;
  1969.                                 data_1=ymax;
  1970.                                 data_1+=ymin;
  1971.                                 Yoffset =data_1/2;
  1972.                                 Xsens = (xmax - xmin)/2;
  1973.                                 Ysens = (ymax - ymin)/2;
  1974.                                 max_min_init();       
  1975.                                 comp_init_flag&=0xf7;
  1976.                 }
  1977.         else
  1978.                 {
  1979.                         r_data=read_stater();
  1980.                         if(r_data&0x01)
  1981.                                 {
  1982.                                 read_data();
  1983.                                 //test_comp();
  1984.                                 xvalue_buf += XRaw;
  1985.                                 yvalue_buf += YRaw;
  1986.                                 if(xmax<XRaw)
  1987.                                         xmax=XRaw;
  1988.                                  if(xmin>XRaw)
  1989.                                         xmin=XRaw;
  1990.                                 if(ymax<YRaw)
  1991.                                         ymax=YRaw;
  1992.                                  if(ymin>YRaw)
  1993.                                         ymin=YRaw;
  1994.                                 i++;
  1995.                                 if(i==6)
  1996.                                         {
  1997.                                         XRaw=(xvalue_buf-xmax-xmin)>>2;
  1998.                                         YRaw=(yvalue_buf-ymin-ymax)>>2;
  1999.                                         cal_compass();
  2000.                                         max_min_init();
  2001.                                         i=0;
  2002.                                         }
  2003.                                 }
  2004.                 }
  2005.        
  2006.        
  2007. }
  2008. #endif
  2009. unsigned int h1x,h1y,h2x,h2y;
  2010. void read_comp_data(void)
  2011. {
  2012.         unsigned char r_data;
  2013.         static unsigned char comp_stater=0,i=0,j=0;
  2014.         unsigned long addx,addy;
  2015.         if(!(comp_init_flag&0x10)){comp_stater=0;return;}
  2016.         switch(comp_stater)
  2017.                 {
  2018.                 case 0:
  2019.                         axis_test_time=0;
  2020.                         comp_start();
  2021.                         comp_send_8_bit(0x60);
  2022.                         comp_send_8_bit(0x07);
  2023.                         comp_send_8_bit(0x80);
  2024.                         comp_stop();
  2025.                         comp_stater++;
  2026.                         break;
  2027.                 case 1:
  2028.                         if(axis_test_time<16)break;
  2029.                         rest_set(0x21);
  2030.                         comp_stater++;
  2031.                         break;
  2032.                 case 2:
  2033.                         r_data=read_stater();
  2034.                         if(!(r_data&0x01))break;
  2035.                         read_data();
  2036.                         h1x=XRaw;
  2037.                         h1y=YRaw;
  2038.                         comp_stater++;
  2039.                         break;
  2040.                 case 3:
  2041.                         axis_test_time=0;
  2042.                         comp_start();
  2043.                         comp_send_8_bit(0x60);
  2044.                         comp_send_8_bit(0x07);
  2045.                         comp_send_8_bit(0x80);
  2046.                         comp_stop();
  2047.                         comp_stater++;
  2048.                         break;
  2049.                 case 4:
  2050.                         if(axis_test_time<16)break;
  2051.                         rest_set(0x41);
  2052.                         comp_stater++;
  2053.                         break;
  2054.                 case 5:
  2055.                         r_data=read_stater();
  2056.                         if(!(r_data&0x01))break;
  2057.                         read_data();
  2058.                         h2x=XRaw;
  2059.                         h2y=YRaw;
  2060.                         addx=h2x;
  2061.                         addx+=h1x;
  2062.                         addx/=2;
  2063.                         addy=h2y;
  2064.                         addy+=h1y;
  2065.                         addy/=2;
  2066.                         max_min_init();       
  2067.                         comp_stater++;
  2068.                         comp_start();
  2069.                         comp_send_8_bit(0x60);
  2070.                         comp_send_8_bit(0x07);
  2071.                         comp_send_8_bit(0x03);
  2072.                         comp_stop();
  2073.                         break;
  2074.                 case 6:
  2075.                         r_data=read_stater();
  2076.                         if(!(r_data&0x01))break;
  2077.                                 read_data();
  2078.                                 //test_comp();
  2079.                                 if(xmax<XRaw)
  2080.                                         {
  2081.                                         xmax=XRaw;
  2082.                                         //test11=YRaw;
  2083.                                         }
  2084.                                  if(xmin>XRaw)
  2085.                                          {
  2086.                                          xmin=XRaw;
  2087.                                         //test21=YRaw;
  2088.                                         }
  2089.                                 if(ymax<YRaw)
  2090.                                         {
  2091.                                         ymax=YRaw;
  2092.                                         //test31=XRaw;
  2093.                                         }
  2094.                                  if(ymin>YRaw)
  2095.                                          {ymin=YRaw;}//test41=XRaw;
  2096.                                 i++;
  2097.                                 if(i>=8)
  2098.                                         {
  2099.                                         i=0;
  2100.                                         compass_data++;
  2101.                                         j++;
  2102.                                         }
  2103.                                 if(j>=40)comp_stater++;
  2104.                         break;
  2105.                 case 7:
  2106.                                 comp_init_flag&=~0x04;
  2107.                                 i=0;
  2108.                                 addx=xmax;
  2109.                                 addx+=xmin;
  2110.                                 Xoffset = addx/2;
  2111.                                 addx=ymax;
  2112.                                 addx+=ymin;
  2113.                                 Yoffset =addx/2;
  2114.                                 Xsens = (xmax - xmin)/2;
  2115.                                 Ysens = (ymax - ymin)/2;
  2116.                                 max_min_init();       
  2117.                                 comp_stater++;
  2118.                         break;
  2119.                 case 8:
  2120.                         r_data=read_stater();
  2121.                         if(!(r_data&0x01))break;
  2122.                                 read_data();
  2123.                                 //test_comp();
  2124.                                 xvalue_buf += XRaw;
  2125.                                 yvalue_buf += YRaw;
  2126.                                 if(xmax<XRaw)
  2127.                                         xmax=XRaw;
  2128.                                  if(xmin>XRaw)
  2129.                                         xmin=XRaw;
  2130.                                 if(ymax<YRaw)
  2131.                                         ymax=YRaw;
  2132.                                  if(ymin>YRaw)
  2133.                                         ymin=YRaw;
  2134.                                 i++;
  2135.                                 if(i==6)
  2136.                                         {
  2137.                                         XRaw=(xvalue_buf-xmax-xmin)>>2;
  2138.                                         YRaw=(yvalue_buf-ymin-ymax)>>2;
  2139.                                         cal_compass();
  2140.                                         max_min_init();
  2141.                                         i=0;
  2142.                                         }
  2143.                         break;
  2144.                        
  2145.                 }
  2146. }
  2147. #define uch unsigned char
  2148. void display1(uch *p1, unsigned int*p2, uch d1)
  2149. {
  2150.         uch buf1,i,buf2,buf6;
  2151.         unsigned int buf3;
  2152.         buf1=*(p1+d1);
  2153.         for(i=0;i<7;i++)
  2154.                 {
  2155.                 buf3=*(p2+i);
  2156.                 buf2=(uch)buf3;
  2157.                 buf6=(uch)(buf3>>8);
  2158.                 if(buf1&0x01)*(display_buf+buf2)|=buf6;
  2159.                 else *(display_buf+buf2)&=~buf6;
  2160.                 buf1>>=1;
  2161.                 }
  2162. }
  2163. void getspeedms(void)
  2164. {
  2165.   if(spend<114)dis_spend1=0.0272;
  2166. else if(spend<174)dis_spend1=0.0241;
  2167. else dis_spend1=0.0234;
  2168. dis_spend1=((float)spend*dis_spend1+0.05)*10;
  2169. if(dis_spend1>711)dis_spend1=711;
  2170. }

  2172. void spend_unit(void)
  2173. {
  2174.         if(!pres_disp_mode)return;
  2175.         flag4|=0x20;       
  2176.         getspeedms();
  2177.         switch(spend_danwei)
  2178.                 {
  2179.                 case 0:
  2180.                         //dis_spend=wr0;
  2181.                         dis_spend=dis_spend1;//spend;//dis_spend1;//m/s
  2182.                         break;
  2183.                 case 1:
  2184.                         dis_spend=dis_spend1*194.4;//knots/h
  2185.                         //dis_pres=(unsigned int)dis_spend;
  2186.                         break;
  2187.                 case 2:
  2188.                         dis_spend=dis_spend1*360;//km/h
  2189.                        
  2190.                         break;
  2191.                 case 3:
  2192.                         dis_spend=dis_spend1*223.69;//mph
  2193.                         break;
  2194.                 }
  2195.         dis_pres=(unsigned int)dis_spend;
  2196. }
  2197. void press_unit()
  2198. {
  2199.         int d;
  2200.         if(pres_disp_mode)return;
  2201.         flag4|=0x20;
  2202.         d=press_data_buf/10+(high_value+high_value1)/10;
  2203.         switch(spend_danwei)
  2204.                 {
  2205.                 case 0:
  2206.                         dis_pres=d;//hpa 1位小数点
  2207.                         if(d>1050)dis_pres=1050;
  2208.                         if(d<850)dis_pres=850;
  2209.                         break;
  2210.                 case 1:
  2211.                         if(d>1050)d=1050;
  2212.                         if(d<850)d=850;
  2213.                         wr0=2.9529988*(float)d;//inhg 2位小数点
  2214.                         dis_pres=(unsigned long int)wr0;
  2215.                         break;
  2216.                 case 2:
  2217.                         if(d>1050)d=1050;
  2218.                         if(d<850)d=850;
  2219.                         wr0=0.75*(float)d;
  2220.                         dis_pres=(unsigned long int)wr0;//mmhg 2位小数点
  2221.                         break;
  2222.                 case 3:
  2223.                         dis_pres=high_value+high_value1;//m        0位小数点               
  2224.                         break;
  2225.                 case 4:
  2226.                         wr0=(float)(high_value+high_value1)*3.24254;// 1/0.3084=3.24254;//0.3048;
  2227.                         dis_pres=(unsigned long int)wr0;//feet 0位小数点
  2228.                         break;
  2229.                 }
  2230. }


  2233. void key_fun(void)
  2234. {
  2235.         int k;
  2236.         if(!(flag2&0x60))return;
  2237.         cant_10s=0;
  2238.         cant_20s=0;
  2239.         flag4|=0x08;
  2240.         if(key_data==0xe0)
  2241.                 {
  2242.                 if(flag2&0x40)
  2243.                         {
  2244.                         if(cant_5s>3)
  2245.                                 {
  2246.                                 flag2&=0x9f;
  2247.                                 if(P_IO_PortA_Data&0x04)P_IO_PortA_Buffer&=~0x04;
  2248.                                 else P_IO_PortA_Buffer|=0x04;
  2249.                                 }
  2250.                         }
  2251.                 else
  2252.                         {
  2253.                         P_IO_PortD_Data=P_IO_PortD_Buffer|0x08;
  2254.                         cant_5s=0;
  2255.                         flag2&=0x9f;
  2256.                         }
  2257.                 return;
  2258.                 }
  2259.         switch(key_stater)
  2260.                 {
  2261.                 case 0:
  2262.                         cant_15s=0;
  2263.                         if(flag2&0x20)//短按
  2264.                                 {
  2265.                                 flag3|=0x20;
  2266.                                 flag3|=0x04;
  2267.                                 if(key_data==0x70)
  2268.                                         {
  2269.                                         time_display_mode++;
  2270.                                         if(time_display_mode>2)
  2271.                                                 {
  2272.                                                 flag0&=0xfd;
  2273.                                                 time_display_mode=0;
  2274.                                                 }
  2275.                                         else flag0|=0x02;
  2276.                                         }
  2277.                                 else if(key_data==0xb0)
  2278.                                         {
  2279.                                                 spend_danwei=0;
  2280.                                                 pres_disp_mode++;
  2281.                                                 if(pres_disp_mode>1)pres_disp_mode=0;
  2282.                                                 if(pres_disp_mode)spend_unit();
  2283.                                                 else press_unit();
  2284.                                                 dark_spend_unit();
  2285.                                                 dark_pres_unit();
  2286.                                                        
  2287.                                                
  2288.                                         }
  2289.                                 else if(key_data==0xd0)
  2290.                                         {
  2291.                                         if(pres_disp_mode)
  2292.                                                 {
  2293.                                                 spend_danwei++;
  2294.                                                 if(spend_danwei>3)spend_danwei=0;
  2295.                                                  spend_unit();
  2296.                                                 }
  2297.                                         else
  2298.                                                 {
  2299.                                                 spend_danwei++;
  2300.                                                 if(spend_danwei>4)spend_danwei=0;
  2301.                                                 press_unit();
  2302.                                                 }
  2303.                                         }
  2304.                                 }
  2305.                         else
  2306.                                 {
  2307.                                         if(key_data==0x70)
  2308.                                                 {
  2309.                                                         cant_15s=0;
  2310.                                                         time_display_mode=0;
  2311.                                                         //flag1|=0x03;
  2312.                                                         key_stater=1;
  2313.                                                         flag0|=0x02;
  2314.                                                 }
  2315.                                         else if(key_data==0xb0)
  2316.                                                 {
  2317.                                                 key_stater=2;
  2318.                                                 weath_mode=0;
  2319.                                                 pres_disp_mode=0;
  2320.                                                 spend_danwei=3;
  2321.                                                 dark_spend_unit();
  2322.                                                 dark_pres_unit();
  2323.                                                 press_unit();
  2324.                                                 }
  2325.                                         else if(key_data==0xd0)
  2326.                                                 {
  2327.                                                 //key_stater=3;
  2328.                                                 //if((comp_init_flag&0x10)&&(comp_init_flag&0x04))comp_init_flag&=0xfb;
  2329.                                             if(!(comp_init_flag&0x10))
  2330.                                                         {
  2331.                                                         comp_init_flag|=0x1f;
  2332.                                                         }
  2333.                                                 else
  2334.                                                         {
  2335.                                                         comp_start();
  2336.                                                         comp_send_8_bit(0x60);
  2337.                                                         comp_send_8_bit(0x07);
  2338.                                                         comp_send_8_bit(0x80);
  2339.                                                         comp_stop();
  2340.                                                         comp_init_flag&=0xef;
  2341.                                                         angle=0;
  2342.                                                         compass_data=0;
  2343.                                                         }
  2344.                                                 flag4|=0x80;
  2345.                                                 }
  2346.                                         else if(key_data==0x90)
  2347.                                                 {
  2348.                                                
  2349.                                                 flag4|=0x20;
  2350.                                                 spend1=0;
  2351.                                                 flag1^=0x01;
  2352.                                                 if(flag1&0x01){P_INT_Ctrl2|=D_ExtI2IntEn;P_IO_PortA_Buffer&=~0x01;}
  2353.                                                 else {P_INT_Ctrl2&=~D_ExtI2IntEn;P_IO_PortA_Buffer|=0x01;}
  2354.                                                 spend_on_5s=0;
  2355.                                                 }
  2356.                                 }
  2357.                         flag2&=0x9f;
  2358.                         break;
  2359.                 case 1:
  2360.                         if(key_data==0x70)
  2361.                                 {
  2362.                                 cant_15s=0;
  2363.                                 flag2&=0x9f;
  2364.                                 time_display_mode++;
  2365.                                 //flag1&=0xf8;
  2366.                                 if(time_display_mode>3)flag0&=0xfd;
  2367.                                 if(time_display_mode>6)
  2368.                                         {
  2369.                                         time_display_mode=0;
  2370.                                         key_stater=0;
  2371.                                         }
  2372.                                 }
  2373.                         else if(key_data==0xb0)
  2374.                                 {
  2375.                                 if((flag2&0x20)||(inc_8_time>=shift_cant))
  2376.                                         {
  2377.                                         inc_8_time=0;
  2378.                                         cant_15s=0;
  2379.                                         flag3|=0x20;
  2380.                                         flag2&=0xdf;
  2381.                                         inc_8_time=0;
  2382.                                         switch(time_display_mode)
  2383.                                                 {
  2384.                                                 case 0:
  2385.                                                                 flag3^=0x40;
  2386.                                                                 flag2&=0x9f;
  2387.                                                                 break;
  2388.                                                 case 1:
  2389.                                                                 year++;
  2390.                                                                 if(year>99)year=17;
  2391.                                                                 //get_wek_data();
  2392.                                                                 break;
  2393.                                                 case 2:
  2394.                                                                 moth++;
  2395.                                                                 if(moth>12)moth=1;
  2396.                                                                 if(moth==2)
  2397.                                                                         {
  2398.                                                                         if(!(year&0x03))
  2399.                                                                                 {
  2400.                                                                                 while(day>29)day--;
  2401.                                                                                 }
  2402.                                                                         else while(day>28)day--;
  2403.                                                                         }
  2404.                                                                 else while(day>moth_table[moth-1])day--;
  2405.                                                                 //get_wek_data();
  2406.                                                                 break;
  2407.                                                 case 3:
  2408.                                                         day++;
  2409.                                                         if(moth==2)
  2410.                                                                 {
  2411.                                                                 if(!(year&0x03))
  2412.                                                                         {
  2413.                                                                         if(day>29)day=1;
  2414.                                                                         }
  2415.                                                                 else if(day>28)day=1;
  2416.                                                                 }
  2417.                                                         else
  2418.                                                                 {
  2419.                                                                 if(day>moth_table[moth-1])
  2420.                                                                         day=1;
  2421.                                                                 }
  2422.                                                         //get_wek_data();
  2423.                                                         break;
  2424.                                                 case 4:
  2425.                                                         hour++;
  2426.                                                         second=0;
  2427.                                                         if(hour>=24)hour=0;
  2428.                                                         break;
  2429.                                                 case 5:
  2430.                                                         mint++;
  2431.                                                         second=0;
  2432.                                                         if(mint>59)mint=0;
  2433.                                                         break;
  2434.                                                 case 6:
  2435.                                                         flag2&=0x9f;
  2436.                                                         flag0^=0x08;
  2437.                                                         flag4|=0x40;
  2438.                                                         break;
  2439.                                                 }
  2440.                                         }
  2441.                                 }
  2442.                         else if(key_data==0xd0)
  2443.                                 {
  2444.                                 if((flag2&0x20)||(inc_8_time>=shift_cant))
  2445.                                         {
  2446.                                         inc_8_time=0;
  2447.                                         cant_15s=0;
  2448.                                         flag3|=0x20;
  2449.                                         flag2&=0xdf;
  2450.                                         inc_8_time=0;
  2451.                                         switch(time_display_mode)
  2452.                                                 {
  2453.                                                 case 0:
  2454.                                                                 flag3^=0x40;
  2455.                                                                 flag2&=0x9f;
  2456.                                                                 break;
  2457.                                                 case 1:
  2458.                                                                 year--;
  2459.                                                                 if(year<17)year=99;
  2460.                                         //                        get_wek_data();
  2461.                                                                 break;
  2462.                                                 case 2:
  2463.                                                                 moth--;
  2464.                                                                 if(moth<1)moth=12;
  2465.                                                                 if(moth==2)
  2466.                                                                         {
  2467.                                                                         if(!(year&0x03))
  2468.                                                                                 {
  2469.                                                                                 while(day>29)day--;
  2470.                                                                                 }
  2471.                                                                         else while(day>28)day--;
  2472.                                                                         }
  2473.                                                                 else while(day>moth_table[moth-1])day--;
  2474.                                                                 //get_wek_data();
  2475.                                                                 break;
  2476.                                                 case 3:
  2477.                                                        
  2478. ……………………

  2480. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

电子指南针
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶顶 踩踩
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表