TMS320C2812电子磁罗盘补偿技术研究(13)
图4.2 AD程序的流程图
4.2.4 航向角的求解
在编写DSP算法时，为了方便，一般都是采用高级语言(如C语言)。本设计的微处理器采用的是TMS320F2812ADSP芯片，采用C语言编写程序。
DSP芯片得到的AD转换输出值是一个12位的数据，需将其还原为实际值才能利用，公式(2-3)～(2-5)进行航向角的解算。以x轴为例，设AD采样后的12位数为VHEX，将其作为无符号数处理,输入AD的模拟量Vx应为:
(4-1)
传感器输出信号的实际电压设为Hx，K1为放大倍数，参考电压为2.5V，则：
(4-2)
同理可得另外两个轴的实际电压为Hy，Hz。
航向角求解子程序：
航向的求解关键在于将它们转化到平面坐标系的四个象限和x、y轴的正
负半轴上，以使航向角可以在360度的范围内连续变化。
#define PI 3.1415926
float GetHeading(float x，float y)
{
float HeadAngle;//定义航向角返回
if((Hexx>0)&&(Heyy)=0)
HeadAngle=0.0;//x轴正半轴
if((Hexx=0)&&(Heyy)<0)
HeadAngle=90.0://s轴负半轴
if((Hexx<0)&&(Heyy)=0)
HeadAngle=150.0://x轴负半轴
if((Hexx=0)&&(Heyy)>0)
HeadAngle=270.0://y轴正半轴
if((Hexx>0)&&(Heyy)<0)
HeadAngle=-180*(atan(Heyy/Hexx))/PI;//第四象限
if(Hexx>0)
HeadAngle=180-180*(atan(Heyy/Hexx))/PI://第二、三象限
if((Hexx>0)&&(Heyy)>0)
HeadAngle=360-180*(atan(Heyy/Hexx))/PI;//第一象限
}
4.3 小结
本章首先介绍了软件开发平台CCS，阐述了软件开发的一般步骤。在对电子磁罗盘的程序组成有了整体了解之后，对整个系统的软件进行了模块化分析，确定各个模块的功能。在此基础上，设计了系统主程序和各子程序的工作流程，并在ICETEK-F2812-A评估板上予以实现。
5 电子磁罗盘系统调试
系统调试过程中，硬件调试和软件调试是相辅相成的，许多硬件错误是在软件调试过程中被发现和纠正的。硬件是软件功能实现的基础，如果硬件调试不通过，软件设计将无从谈起，因此当出现问题时，一般先检查是否是硬件电路故障，排除明显的硬件故障之后，在此基础上再和软件进行联合调试，直至系统正常运行。
5.1 硬件调试
硬件检查最基本的工作是检查电路板走线和元器件焊接是否正确，包括错焊、少焊、多焊的检查。由于本系统体积小，相应元器件的封装均为表贴式，要求焊接时焊锡要尽量少但必须保证没有虚焊，同时引脚之间也不能有短路现象;必须保证电源供电的正、负极连接正确;用万用表测量电路板电阻值保证非零，以确保电路端对地不存在短路。
完成基本的电气焊接检查之后，需要对电路板加电，检查各单元电路是否按照设计要求正常工作。加电后，观察电路板有无异常现象，如冒烟、异等，若有，应立即断开电源并进行故障的检查与排除。没有明显的异常现象之后，要加电测量电路关键点的电压，如供电电压、仪器放大器参考电压等;一切正常之后，需要检查各单元电路是否正常工作，如仪器放大器倍数是否准确等。通过不断检查电气连接、调整参数设置或者更换元器件，直至使各单元电路工作正常，符合设计要求。