others.c

来自「基于陀螺仪原理的惯性导航程序 用于测量量角速度」· C语言 代码 · 共 68 行

#include "my_type.h"
#include <ADuC7020.H>
#include "UART.H"
#include "LED.H"
#include "ADC.H"
#include "math.H"
///////////////////////////////////////
extern uint16  AD_value[3];
                           //固定坐标系下位移
extern float   Z_w_result;
extern int ZERO_V;
/////////////////////////////////////////

/**************************简单的延时函数*****************************/
void Delay_X_ms(uint32 x)
{
 uint32 i;
 while(x--)
  {
   i=1000;
   while(i--);
  }
}
/**********************************************************************/

//////////////////////////////将w角度显示出来/////////////
void print_Z_w(void)
{

// uint16 value;
 int zero;
 uint32 result;
 uint8 s_result[14];

 if(Z_w_result>=0)
 {prints("+",0);}
 else{prints("-",0);}
 zero = ZERO_V;
 result=(int)((fabs)(Z_w_result*10));
 s_result[14]=0;				  //将结果转换成字符串

 s_result[13]='0'+zero%10;
  zero/=10;
  s_result[12]='0'+zero%10;
   zero/=10;
   s_result[11]='0'+zero%10;
    zero/=10;
    s_result[10]='0'+zero%10;
	 s_result[9]='z';
 s_result[8]=' ';
 s_result[7]='u';
 s_result[6]='d';
 s_result[5]='0'+result%10;
 result/=10;
 s_result[4]='.';
 s_result[3]='0'+result%10;
 result/=10;
 s_result[2]='0'+result%10;
 result/=10;
 s_result[1]='0'+result%10;
 result/=10;
 s_result[0]='0'+result%10;
	  
 prints(s_result,1);
}
//////////////////////////////////////////////////////////////////////////////