一种无人艇环境数据仿真方法与流程

本发明属于无人船环境仿真软件系统涉及技术领域，尤其涉及一种实时生成雷达辐条的仿真方法。

背景技术

无人艇是一种无人操作的水面舰艇。主要用于执行危险以及不适于有人船只执行的任务。一旦配备先进的控制系统、传感器系统、通信系统和武器系统后，可以执行多种战争和非战争军事任务。为测试和验证无人艇控制系统的有效性，提高无人艇作战系统开发效率，减少试验成本，通过模拟无人艇所处的环境，建立无人艇环境仿真系统是研究无人艇的必要手段。

技术实现要素：

为了克服上述背景技术的缺陷，本发明提供一种无人艇环境数据仿真方法，测试和验证无人艇控制系统的有效性，提高无人艇作战系统开发效率，减少试验成本。

为了解决上述技术问题本发明的所采用的技术方案为：

一种无人艇环境数据仿真方法：

步骤1，建立无人艇运动模型和海上目标运动模型；

步骤2，根据无人艇当前状态，按照标准导航格式规定的导航参数，实时计算无人艇的仿真导航数据；

步骤3，根据无人艇的导航状态和当前仿真海上运动目标的位置，实时计算无人艇导航雷达输出的雷达辐条数据；

步骤4，依据标准导航格式和雷达辐条数据格式，构建网络通信报文，将无人艇环境仿真数据输出至通信网络。

较佳地，步骤1建立无人艇运动模型包括建立无人艇位移运动模型，获取无人艇位移运动模型为无人艇的经纬度坐标其中，δλ和为无人艇在位移时间δt内对应的经纬度改变量，为无人艇在启动位移时刻t0的经纬度坐标。

较佳地，步骤1建立无人艇运动模型包括建立无人艇姿态运动模型，获取无人艇姿态运动模型包括无人艇运动到t时刻的

横摇角

纵摇角

升沉

其中，tr,tp,th分别为无人艇的横摇角摆动周期、纵摇角摆动周期和升沉周期，sr,sp,sh分别为无人艇的横摇角摆动幅值、纵摇角摆动幅值和升沉摆动幅值，θr,θp,θh分别为无人艇的横摇角初始摆动相位、纵摇角初始摆动相位和升沉初始摆动相位。

较佳地，步骤1建立海上目标运动模型包括获取在t时刻第i个目标相对无人艇的

距离

方位

其中，为时刻t第i个目标相对无人艇的位置。

较佳地，步骤2根据无人艇当前状态，按照标准导航格式规定的导航参数，实时计算无人艇的仿真导航数据各字段的方法包括：

人工设定无人艇当前航向角c0，

获取无人艇当前纵摇值pitch＝spsin(2πt/tp+θp)，

获取无人艇当前横摇值roll＝srsin(2πt/tr+θr)，

获取无人艇当前升沉值heave＝shsin(2πt/th+θh)，

获取无人艇当前的经纬度坐标λ0+δλ和

获取无人艇当前的东向速度ve＝v0cos(c0)、北向速度vn＝v0sin(c0)和天向速度vu＝shsin(2πt/th+θh)′＝2πsh/thcos(2πt/th+θh)，

其中，sp为纵摇角的摆动幅值，tp为纵摇角的摆动周期，θp为纵摇角的摆动相位，sr为横摇角的摆动幅值，tr为横摇角的摆动周期，θr为横摇角的摆动相位，sh为升沉的摆动幅值，th为升沉的摆动周期，θh为升沉的摆动相位，为无人艇在启动位移时刻t0的经纬度坐标，δλ和为无人艇在位移时间δt内对应的经纬度改变量，t为当前时间。

较佳地，步骤2是按照标准gpfps导航报文数据格式计算无人艇的仿真导航数据。

较佳地，步骤3具体包括；

步骤3.1，建立雷达辐条数据生成模型，记雷达扫描半径r，雷达转速w，记雷达扫描一周的辐条数为m，一个扫描周期内的辐条编号为j，指向正北的辐条编号j＝0，辐条编号随辐条顺时针排列逐个增加，t时刻仿真目标的数量为n，第i个目标中心点对应的距离为方位为目标回波半径为ri；

步骤3.2，仿真目标集合为t＝{t1,t2,...,tn}，计算所有目标的回波的方位角范围，记第i个目标的回波方位角范围为其中，记目标回波范围集合

步骤3.3，逐个计算雷达辐条回波与目标相交情况，记雷达辐条距离采样点数量为s，第j个辐条对应的方位角度azij为遍历目标回波范围集合trange，若存在则第j个辐条能显示第i个目标的回波；

步骤3.4，根据辐条相交情况计算辐条数据，记与辐条j相交的目标的面积的集合为对雷达辐条采样点按照序号遍历，记第j个雷达辐条的第k个采样点的数值为spoke(j,k)，其中(k＝1,2,...s,，)若则spoke(j,k)＝1，第k个采样点存在回波，若则spoke(j,k)＝0，第k个采样点不存在回波。

较佳地，步骤4的方法包括：首先将导航数据和雷达辐条数据按照标准导格式和标准雷达辐条格式编码。其次设置网络发送模式以及ip地址和端口号，最后环境数据以udp数据报文的格式发送至指定地址。

本发明的有益效果在于：使用计算机仿真的方法，模拟无人艇导航雷达和导航设备的输出信息，为无人艇的雷达多目标跟踪系统、航行控制系统、雷达避障系统等任务系统提供模拟环境下的驱动数据，通过设置无人艇航行状态和各种仿真环境的场景，能测试和验证各任务系统的有效性，提高无人艇作战系统开发效率，降低试验成本。

附图说明

图1为本发明实施例目标距离和方位的示意图，

图2为本发明实施例仿真目标回波角度范围示意图，

图3为本发明实施例仿真雷达辐条计算示意图，

图4为本发明实施例雷达spoke数据计算示意图，

图5为本发明实施例仿真系统运行工作流程图。

具体实施方式

下面结合附图和实施例对本发明做进一步的说明。

本发明是通过以下技术方案实现的：

一种适用于海上无人艇环境仿真的方法，包括无人船导航系统仿真模块、海上目标仿真模块、雷达态势显示与数据仿真模块、数据编码通信模块，所述的无人船导航系统仿真模块通过设置船舶位置、速度、摇摆周期等参数，实时生成无人艇导航状态信息，所述的海上目标仿真模块通过输入目标运动参数信息，实时生成仿真海上目标，所述的雷达态势显示与数据仿真模块通过处理无人艇导航状态信息和海上目标信息，计算实时雷达辐条数据，显示雷达态势，所述的数据编码通信模块对雷达辐条数据和导航数据编码，最后将无人艇环境仿真数据发送至网络。

该发明包括如下步骤：

步骤1，建立无人艇姿态和运动模型，建立海上运动目标运动模型。

步骤1.1，无人艇位移运动模型的建立方式如下：

记t0时刻无人艇的经纬度坐标为航向为c0，航速为v0。则经过δt后，无人艇在x方向和y方向的位移δx和δy分别为：

δx＝v0δt×sin(c0)

δy＝v0δt×cos(c0)

无人艇在δt时间内的位移对应的经纬度改变量δλ，用近似公式可表示为：

此时无人艇的经纬度坐标为α为经度相同时纬度改变1度时产生的距离差，α的值优选为111700米。

步骤1.2，无人艇姿态运动模型的建立方式如下：

记无人艇的横摇角、纵摇角和升沉的摆动周期分别为tr,tp,th，摆动幅值分别为sr,sp,sh，初始摆动相位分别为θr,θp,θh。则t时刻无人艇的横摇角rt、纵摇角pt和ht为：

步骤1.3，目标运动模型的建立方式如下：

记仿真的目标数量为n，设第i个目标的速度为航向为在t0时刻相对无人艇的距离和方位分别为

第i个目标相对无人艇在x方向和y方向的航速vix′、viy′的表达式分别为

当无人艇和目标运动都为线性时，t时刻第i个目标相对无人艇的位置距离方位分别为：

步骤2，根据无人艇当前状态，按照标准导航格式规定的导航参数，以50hz的频率实时计算无人艇的仿真导航数据。

标准gpfps导航报文数据格式如下：

$gpfps,gpsweek,gpstime,heading,pitch,roll,lattitude,longitude,altitude,headdc,heave,ve,vn,vu,baseline,nsv1,nsv2,status*cs<cr><lf>

表1导航报文数据格式表

根据步骤1当中的无人艇运动和姿态模型，各字段的数值计算公式如表所示：

表2导航报文数据计算公式

其中，

(1)报文报头及时间信息(字段1-3)

字段1header为固定信息，取值为“$gpfps”，

字段2gpsweek和3utctime取系统当前时间。

(2)无人艇当前航信息(字段4)

字段号4heading表示无人艇当前航向，取值为c0。

(3)无人艇当前姿态信息(字段5、6、11)

字段号5pitch、6roll、11heave分别表示无人艇当前纵摇值、横摇值和升沉，根据步骤一中的无人艇姿态运动模型，字段号5、6、11分别取值为spsin(2πt/tp+θp)、srsin(2πt/tr+θr)和shsin(2πt/th+θh)。

(4)无人艇当前位置信息(字段7-10)

字段号7lattitude和8longitude分别表示无人艇当前的纬度坐标和经度坐标，根据步骤一中的无人艇运动模型，字段号7lattitude和8longitude分别取值为和λ0+δλ。

字段号9altitude表示无人艇当前高度，取固定值“0”。

字段号10head_dc表示无人艇偏流角，取固定值“0”。

(5)无人艇当前速度信息(字段12-14)

字段号12ve、13vn、14vu分别表示无人艇当前东向速度、北向速度和天向速度。其中根据步骤一的中的无人艇运动模型，东向速度和北向速度分别为v0cos(c0)和v0sin(c0)，无人艇天向速度通过步骤一姿态运动模型中的升沉信息对时间求导可以得到。即无人艇的天向速度的表达式为

vu＝shsin(2πt/th+θh)′＝2πsh/thcos(2πt/th+θh)。

(6)无人艇gps卫星信息(字段15-17)

字段号15baseline表示gps接收天线之间的距离，字段号16nsv1和17nsv2表示两个gps接收天线接收到卫星数量，由于输出仿真导航数据，设定上述字段为固定值即可。

字段号15取固定值“10”，字段号16取固定值“12”，字段号17取固定值“12”。

步骤3，根据无人艇的导航状态和当前仿真海上运动目标的位置，实时计算无人艇导航雷达输出的雷达辐条数据。建立雷达辐条数据生成模型具体包括如下步骤：

步骤3.1，设雷达扫描半径r，雷达转速w，记雷达扫描一周的辐条数为m，一个扫描周期内的辐条编号为j,指向正北的辐条编号j＝0，辐条编号随着顺时针增加，根据步骤一，t时刻仿真目标的数量为n，第i个目标中心点对应的距离为方位为目标回波半径为ri。

步骤3.2，仿真目标集合为t，t＝{t1,t2,...,tn}，计算所有目标的回波的方位角范围。记第i个目标的回波方位角范围为其中记目标回波范围集合

步骤3.3，逐个计算雷达辐条回波与目标相交情况，记雷达辐条距离采样点数量为s。第j个辐条对应的方位角度azij为遍历目标回波范围集合trange，若存在表明第j个辐条能显示第i个目标的回波。图3表示第341号辐条能显示目标t1，第364号辐条能同时显示目标t1和t2。

步骤3.4，根据辐条相交情况计算辐条数据。记与辐条j相交的目标的面积的集合为对雷达辐条采样点按照序号遍历，记第j个雷达辐条的第k个采样点的数值为spoke(j,k)其中(k＝1,2,...,s)，若则spoke(j,)k＝1，表示该采样点存在回波，若则spoke(j,k)＝0，表示该采样点不存在回波。考虑图3情况下，j＝364时，雷达spoke数据计算示意图如图4表示。

步骤4，依据标准导航格式和雷达辐条数据格式，构建网络通信报文，将无人艇环境仿真数据输出至通信网络，具体方法包括：

首先将导航数据和雷达辐条数据按照标准导格式和标准雷达辐条格式编码。其次设置网络发送模式以及ip地址和端口号，最后环境数据以udp数据报文的格式发送至指定地址。

应当理解的是，对本领域普通技术人员来说，可以根据上述说明加以改进或变换，而所有这些改进和变换都应属于本发明所附权利要求的保护范围。