DS750方位探管手册.docx
《DS750方位探管手册.docx》由会员分享,可在线阅读,更多相关《DS750方位探管手册.docx(14页珍藏版)》请在冰豆网上搜索。
DS750方位探管手册
DS750方位探管--使用手册--
1介绍
本手册介绍了DS750高温连续测斜短节的外形尺寸、性能参数、软件参数配置方法及通信协议等。
2描述
DS750高温连续测斜短节包含3轴磁通门计和3轴加速度计。
倾角和重力工具面角由3轴加速度计测量,当倾斜角和重力工具面角测量后,由三轴磁通门测量出短节方位角,重力工具面角和倾角测量精度为±0.1°,方位角测量的精度为±0.3°。
除此之外短节还可以测量总加速度、总磁场强度、磁性工具面角、地磁倾角,温度。
DS750通过双向TTL接口,采用ASCII描述指令语言进行通信。
DS750软件包含自动发送数据模式,能以最高60次/秒的速率重复发送数据。
DS750具备待机功能,可以通过发送指令将磁通门和加速度计关闭供电,使短节进入低功耗待机模式,功耗降低可达80%以上。
3性能参数
序号
项目
单位
规定值
1
电源电压
V
10~36
±12~±15
2
静态电流
mA
75mA@15V
100mA@+15V,80mA@-15V
3
工作温度
℃
0~150
4
贮存温度
℃
-40~160
5
绝缘电阻
MΩ
100MΩ(100V)
6
井斜角范围
度
0~180
7
方位角范围
度
0~360
8
工具面角范围
度
0~360
9
井斜测量精度
度
±0.1
10
方位角精度
度
±0.3@90°
度
±1@10°
度
±2°@5°
11
工具面角精度
度
±0.1
4外形图
DS750-A外形图DS750-B外形图
DS750-C外形图DS750-D外形图
5电气接口
DS750采用MDM型连接器,连接器引脚的功能如图所示。
DS750输入电压范围为单电源+10V~+36V(或双电源±12~±15),采用UART串行通信接口,兼容TTL和CMOS电平。
默认为波特率9600,有一个停止位,无同步位,用户可以通过设定短节EEROM中的参数来改变波特率。
DS750可使用两种通信协议:
1)ASCII
ASCII协议基于发送ASCII字符(指令)到DS750来获取数据。
为响应指令,发送数据,以ASCII数据流包括回车和换行发出,很容易地显示在电脑显示终端上(通过一个TTL到RS232转换器)。
2)二进制
二进制协议用于MCU之间高速数据传输。
在这种模式下,发送1个字节来请求数据,DS750用多字节数据包回复,数据包包括所需数据、数据头、校验位和和数据尾,发送请求指令的频率最高可至500次/秒。
DS750的MDM连接器引线定义见下图,其中有上下连接器之间的贯通线,有些贯通线绞在一起通过短节,避免贯通线上电流对磁通门的影响,需要使用绞在一起的线当做电源线,且通过电流不宜过大,上下连接器的电源输入和电源输出线在短节内部直连。
A型上下9针连接器
B型上15针下9针连接器
C型单9针连接器
D型上15针下9针连接器
6电脑接口
DS750短节的通信接口是UART(TTL/CMOS兼容)串行接口。
在标准配置中,通过脚RX端将数据传送到DS750,通过脚TX将数据从DS750输出。
默认波特率值为9600,有一个停止位,没有奇偶校验位。
为了与外部PC进行通信,DS750的TTL接口必须转换成RS332接口,适用于所有PC的串行接口。
当打开电源时,9600波特率下传送以下信息:
DS750:
S/NXXXXXXX
Ver:
1.0
在上面的信息中,X代表产品编号。
6.1DS750二进制常量及其设置方法
DS750运行模式由内部二进制常量值控制。
表1二进制常量描述
二进制常量
数值
描述
01
5a
启动自动发送模式
02
02
传感器分量
04
角度输出
08
10
上电后自动发送ASCII格式数据
11
上电后自动发送二进制格式数据
09
波特率锁定,必须为5a时才能更改9600以外的波特率
10
波特率设定,见表2
23
设置输出数据平均值次数,见表3
35
设置自动模式发送数据包之间的延时
为了改变短节的二进制常量,必须首先发送指令:
0L##
当该指令发送至DS750,将得到以下回复:
enabled
更改二进制常量02=04,发送指令:
0WC02b04##
当收到该指令后,DS750会做出回复:
done
读取二进制常量02,发送指令:
0SC02b##
当收到该指令后,DS750会回复二进制常量02的值。
以上指令不区分大小写。
6.1.1波特率设置
DS750通信波特率默认值是9600,波特率可通过以下步骤进行设置:
根据表2设置二进制常量10;
设置二进制常量09为0x5a;
重新上电
例如,以下指令描述设置波特率至115200
0L##
0WC10b07##
0L##
0WC09b5a##
当二进制常量09设置为任意值(除了0x5a),短节波特率为9600。
表2波特率设置
波特率
二进制常量10的值
300
0x35
1200
0x33
2400
0x32
4800
0x31
9600
0x30
19200
0x05
38400
0x06
115200
0x07
6.1.2滤波器和平均值设置
在强振动的环境中,DS750通过对输出数据进行数字低通滤波和取平均值使输出数据更加稳定。
DS750内部采用4阶巴特沃斯数字低通滤波器对输出数据进行滤波,其-3dB截止频率可以通过以下指令设置:
读取当前截止频率值
0SF##
设置截止频率频率
0L##
0WFxx##
xx=整数值10、20、30、40、50、60、70、80、90、99
滤波器截止频率频率越低,响应越慢,默认值设置为30Hz。
除数字滤波外,DS750的每个输出数据为前n个数据的平均值,n的值通过设置二进制常量23来改变,不同的n值会影响传感器从0g到1g的响应时间。
以下平均数据个数均在低通滤波截止频率为30Hz时测得。
二进制常量23的值
n
到达稳态值±0.1%的时间
2
2
1.5s
4
4
2s
8
8
3s
10
16
4s
20
32
7s
40
64
14s
80
128
28s
若要求DS750能在10G峰峰值,频率20~100Hz的振动情况下精确测量角度,需要将滤波器截止频率设置为10Hz,平均值个数n设置为128,指令格式为:
0L##
0WF10##
0L##
0WC23b80##
6.2自动发送配置
当二进制常量01=0x5a时,DS750为自动发送模式,数据格式通过二进制常量08进行设置。
表3自动发送模式
自动发送模式
二进制常量08值
发送ASCⅡ数据
0x10
发送二进制数据
0x11
可以通过更改二进制常量35来改变自动发送数据包之间的时间间隔,指令格式如下:
0L##
0WC35bxx##
其中xx=01、02、03、04、05、06、07、08、09、10,分别代表延时为0.1s~1s。
6.3单数据包发送配置
6.3.1ASCII码通信模式
当发送指令如ASCII字符0SD时,DS750以固定输出回复,当二进制常量02=02时,DS750处于分量数据上传模式,输出数据格式如下:
GX:
+0.86629HX:
+0.47865
GY:
+0.49926HY:
-0.10486
GZ:
-0.0052HZ:
+0.02971
TEMP:
+102.39021
以上数据表示X、Y和Z加速度计输出(g)和磁通门输出(高斯)。
当二进制字节02=04,DS750处于角度上传模式,输出数据格式如下:
ROLL:
+90.58164MAGROLL:
+285.83145
PITCH:
+29.90435MAG:
+0.49073
HEAD:
+4.97338GRAV:
+0.99906
TEMP:
+85.10032DA:
47.58007
ROLL为重力工具面角,PITCH为倾角,HEAD为方位角,MAGROLL为磁性工具面角,MAG为总磁场,GRAV为总重力场,DA为地磁倾角。
6.3.2二进制通信模式
6.3.2.1分量数据上传模式
收到0x80,DS750通过发送二进制传感器分量数据包进行响应(双字节数据,高字节在前):
<80><0601><02><0604>
<80>指令返回(即主机发送指令0x80的返回值);
<0601>分量数据上传同步头,如果数据或者CRC校验码中出现06,DS750会重复发送一次06;
<02>分量数据上传模式;
是双字节(x轴磁传感器数据乘以10000);
是双字节(x轴加速度传感器数据乘以10000);
同上面分量格式;
是双字节(温度传感器数据乘以100);
是双字节(输入电压数据乘以100);
CRC校验位;
<0604>同步尾;
6.3.2.2角度数据上传模式
收到0x83,DS750通过发送二进制传感器分量数据包进行响应(双字节数据,高字节在前)。
<83><0602><03><0604>
<83>指令返回(即主机发送指令0x83的返回值);
<0602>计算数据上传同步头,如数据或CRC校验码中出现06,DS750会重复发送一次06;
<03>计算数据上传模式;
是双字节(重力工具面角计算数据乘以10);
是双字节(磁工具面角计算数据乘以10);
是双字节(倾角计算数据乘以10);
是双字节(总磁场强度计算数据乘以10000);
是双字节(方位角计算数据乘以10);
是双字节(总加速度计算数据乘以10000);
是双字节(温度传感器数据乘以100);
是双字节(输入电压数据乘以100);
<0000>无效填充,备用;
<0604>同步尾;
6.4待机功能启动
可通过指令控制DS750待机模式和工作模式,进入待机后,加速度计和磁通门传感器关闭供电,短节低功耗运行,指令格式如下:
进入待机模式:
0L##
0PM0##
进入工作模式:
0L##
0PM1##
待机模式后,DS750只对启动工作模式指令响应;除发送指令外,重新上电也可以使DS750进入工作模式。
7短节坐标系及角度定义
DS750短节用顶部圆柱形的两个定位销定义坐标系方向。
短节的X,Y和Z轴的方向如图1所示。
若X轴箭头指向北半球的北方,则X轴磁通门输出电压为正;如果X轴箭头指向下方,则X轴加速度计输出为正。
角度的定义可以参照下图。
以下为DS750计算角度的公式方程,其中
Gx加速度计x轴输出;
Gy加速度计y轴输出;
Gz加速度计y轴输出
Hx磁通门x轴输出;
Hy磁通门y轴输出;
Hz磁通门z轴输出
图2
7.1重力工具面角和磁性工具面角计算
重力工具面角为从Y轴加速度计输出为0,Z轴加速度计输出为正时的位置顺时针转到当前位置时到所转过的角度(从X轴的反方向看)。
重力工具面角θ根据以下公式计算(0≤θ<2π)
当Gy=0且Gz>0时,重力工具面角θ=0;当Gy=0且Gz<0时,重力工具面角θ=π。
当x轴接近竖直时(倾角<5°),分量Gy和Gz变小导致θ精度变差。
在这种情况下,磁性工具面角θm常用于确定DS750方位角。
磁性工具面角为从Y轴磁通门输出为0,Z轴磁通门输出为正时的位置顺时针转到当前位置时到所转过的角度(从X轴的反方向看)。
磁性工具面角θm根据以下公式计算(0≤θ<2π)
7.2倾角计算
倾角为X轴于与竖直方向的夹角,当X轴竖直向下时倾角向下等于0,当X轴水平方向倾角为π/2度,当X轴竖直向上时倾角等于π。
倾角ε根据以下公式计算(0≤ε≤π)
其中g=
7.3方位角计算
方位角为从磁北方向(从上看顺时针)到短节X轴在水平面上投影所转过的角度,当DS750的X轴指向磁北时,方位角为0,指向东时,方位角为π/2,方位角
根据以下公式计算(0≤ε≤2π)。
其中g=