《一种水下定位导航系统和方法.pdf》由会员分享,可在线阅读,更多相关《一种水下定位导航系统和方法.pdf(10页完整版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 103823205 A (43)申请公布日 2014.05.28 CN 103823205 A (21)申请号 201410073287.0 (22)申请日 2014.02.28 G01S 5/18(2006.01) (71)申请人 上海交通大学 地址 200240 上海市闵行区东川路 800 号 (72)发明人 关新平 赵健康 王红雨 贺超峰 (74)专利代理机构 上海汉声知识产权代理有限 公司 31236 代理人 郭国中 (54) 发明名称 一种水下定位导航系统和方法 (57) 摘要 本发明公开了一种水下定位导航系统和方 法, 所述系统由至少四个基站和至少一个水下。
2、定 位导航接收机组成。 基站之间需要时间同步, 基站 布置在水面、 水中或水底。 基站的位置固定或者移 动均可。基站向水中广播导航信号。用伪随机扩 频码对导航信号进行扩频, 扩频码同时起到测距 码的作用。水下定位导航接收机不需要向外部发 射信号, 通过接收基站的导航信号, 解算出自身位 置并实现与基站时间同步。系统中可以有多台水 下定位导航接收机同时接收导航信号, 其数量不 受限制。本发明可以用于水下勘探、 水下施工、 水 下安防、 水下导航等领域。 (51)Int.Cl. 权利要求书 2 页 说明书 5 页 附图 2 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书。
3、2页 说明书5页 附图2页 (10)申请公布号 CN 103823205 A CN 103823205 A 1/2 页 2 1. 一种水下定位导航系统, 该系统由至少 4 个基站和至少一个水下定位导航接收机组 成, 其中 : 所述基站之间时间同步, 通过扩频通信的模式向水下广播导航信号, 其中用伪随机扩 频码对导航信号进行扩频, 扩频码同时起到测距码的作用 ; 所述水下定位导航接收机不需要向外部发射信号, 根据接收到的基站信号, 解算出自 身位置, 并实现与基站时间同步 ; 系统中可以有多台水下定位导航接收机同时接收导航信 号, 其数量不受限制。 2. 根据权利要求 1 所述的一种水下定位导航。
4、系统, 其特征在于, 所述基站的导航信号 采用双极性二进制编码, 即其取值为 +1 或 -1, 分别对应二进制的 0 和 1, 导航信号包含测距 码、 导航电文信息 : 所述测距码是一组长度固定的伪随机码, 其长度为 PZ, 周期为 PP; 每个基站对应一个特 定序列的伪随机码, 记为 Pi, 不同的 Pi相互准正交, 即它们的互相关函数的峰值 PCMi与自相 关函数的峰值 PCSi之间的关系满足 根据测距码 Pi即能确定其对应的基站 Si; 所述导航电文包含基站时间, 基站位置信息, 导航电文的每个二进制位的长度为测距 码周期 PP的整数倍。 3.根据权利要求1或2所述的一种水下定位导航系统。
5、, 其特征在于, 所述基站的绝对位 置或者相对位置已知, 基站之间保持时钟同步。 4.根据权利要求1或2所述的一种水下定位导航系统, 其特征在于, 所述基站布置在水 面、 水中或水底, 基站的位置固定或者移动。 5.根据权利要求1或2所述的一种水下定位导航系统, 其特征在于, 所述基站以声波的 形式, 向水下发射导航信号, 信号调制模式采用扩频通信模式。 6. 一种水下定位导航方法, 该方法包括基站发射导航信号步骤、 水下定位导航接收机 接收基站信号并进行定位导航解算步骤 ; 基站记为 Si, 其中 i=1,2,m, 其中 m 为基站数量, m 4, 基站的位置坐标分别 Sci=(xi,yi,。
6、zi) ; 所述基站发射导航信号步骤, 具体如下 : 生成导航电文, 记为 Di, 导航电文由同步帧和信息帧组成, 同步帧是一组固定的二进 制数据, 记为 T ; 信息帧包含了基站时间和基站位置坐标 ; 利用测距码作为扩频码, 对导航电文进行扩频, 得到扩频信号, 记为 Ki, Ki=DiPi; 利用扩频后的信号 Ki, 对载波进行调制, 所有基站时间同步, 实现载波同步, 即所有 基站的载波频率相位同步, 记为 C, 导航信号记为 Xi, Xi=CKi=CDiPi; 将导航信号 Xi通过基站发射到水中 ; 所述水下定位导航接收机接收基站信号并进行定位导航解算, 具体如下 : 定 位 导 航 。
7、接 收 机 在 水 下,其 坐 标 为 Rci=(x,y,z),与 基 站 之 间 的 距 离 为 开始的时候, 接收机的时间, 记为 t, 与基站时间 t0不 同步, 其时间差为 t=t0-t ; 接收到基站发射的导航信号, 记为 Y, 系统中有多个基站, 接收 权 利 要 求 书 CN 103823205 A 2 2/2 页 3 到的信号 Y 包含了多个基站发射的信号, 然后进行定位导航解算。 7. 根据权利要求 6 所述的一种水下定位导航方法, 其特征在于, 所述定位导航解算, 具 体步骤如下 : 信号解调分离 : 利用码测距码 Pi的正交性, 将各个基站的信号解调并分离出来 ; 即 :。
8、 依次将各个测距码 Pi依次与信号 Y 进行相关运算, 如果相关运算的结果大于设定的阈值, 则该路信号对应了第 i 个基站发射, 经过水体传播后, 被接收机接收到的信号, 记为 Yi; 信号跟踪 : 实现信号分离之后, 对各路信号 Yi分别跟踪 ; 即在 t 时刻, 将信号 Yi依次 与对应的测码 Pi进行相关运算, 测出相关峰值相对于的开始位置的时间, 称为码相位; 帧同步及导航电文解析 : 接收到的信号 Yi与同步帧 T 比对, 确定导航电文的开始时 刻, 记为 tSi, 从 tSi时刻开始, 对测距码进行整周期计数, 计数值记为 Ni; 依次对导航电文进 行解析, 得到基站位置和基站时间。
9、 ; 伪距测量 : 利用从帧同步开始的计数值 Ni和码相位计算出导航信号从基站 Si到 接收机的传播时间 Ti,根据声波在水中的传播速度 c 计算基站 Si到接收机 的伪距Li, Li=cTi; 传播时间Ti包含了接收机与基站的时间差t, 伪距Li、 基站Si到接收 机之间的实际距离 LSi关系为 : Li=LSi+c t ; 定位解算 : 水下定位导航接收机接收到一个基站的信号, 即得到一个伪距, 接收到全 部 m 个基站信号之后, 即获得 m 个伪距方程, 组成如下方程组 以上方程组有 4 个未知数 : x,y,z, t, 方程组中独立方程的个数 m 4, 求解方程组, 得获得接收机的位置。
10、坐标 x,y,z 以及与基站的时间差 t, 利用 t 对接收机时间进行修 正, 即实现接收机时间 t 与基站时间 t0同步。 权 利 要 求 书 CN 103823205 A 3 1/5 页 4 一种水下定位导航系统和方法 技术领域 0001 本发明涉及水下定位导航领域, 尤其涉及水下目标隐蔽情况下的定位导航以及时 间同步技术。 背景技术 0002 水下导航定位导航技术在海洋监测、 海洋勘探、 海洋维权、 水下考古、 水下施工、 水 下安保及军事等领域有非常重要的应用价值。 基于声学的水下定位导航系统按照水声信号 的传播路径, 主要分为两类 : 双程模式和单程模式。 0003 双程模式又称作应。
11、答模式, 需要水下定位设备配置收发应答器。基站和应答器之 间双向收发水声信号实现定位。传统的长基线、 短基线和超短基线定位系统大都是双程模 式。双程模式的优点是水下应答器和基站之间不需要时间同步。缺点是 : 1. 水下应答器需 要向外界发射声波信号, 增加了功耗, 隐蔽性差。2. 由于需要双向收发信号, 水下应答器的 数目受制与基站的处理能力, 不能无限增加。 0004 单程模式又称非应答模式。基站和水下定位设备之间单向传送信号即可实现定 位。目前单程定位系统都是水下信标向基站发送信号, 基站根据接收到信号的特征解算出 水下信标的位置。这种模式下, 水下信标的数目也受制于基站处理能力。 000。
12、5 目前的单程和双程模式, 其信标的位置解算都是在基站或者船基、 岸基完成。 信标 不能直接获得自身位置。如果水下设备 (如水下潜航器) 需要根据自身位置实现自主航行, 则需要通过额外的通信链路, 将位置信息从基站发送给水下设备。 0006 经检索, 中国专利申请号CN200310118440的发明专利公开了一种水下GPS定位导 航方法和系统, 可以实现水下目标定位导航与授时。该方法有以下局限性 : 1. 系统所需部 件庞大, 需要至少5个浮标 (基站) , 数据中心、 海面无线通信链路, 水下无线通信链路。 2.水 下导航接收机与基站需要双向通信。水下定位导航接收机需要向外发射水声信号, 功。
13、耗大 且不利于隐蔽。3. 水下定位导航接收机数量不能无限增加。4. 水下导航接收机无法直接 获得自身位置。 数据中心解算出位置之后, 通过水声通信链路发送给水下定位导航接收机。 增加了定位所需的时间, 降低了可靠性。 发明内容 0007 针对现有技术的缺陷, 本发明提供一种水下定位导航系统和方法, 实现基于扩频 通讯广播模式的单程水下定位导航。 0008 根据本发明的一个方面, 提供一种水下定位导航系统, 该系统由至少 4 个基站和 至少一个水下定位导航接收机组成, 其中 : 0009 所述基站之间时间同步, 通过扩频通信的模式向水下广播导航信号, 其中用伪随 机扩频码对导航信号进行扩频, 扩。
14、频码同时起到测距码的作用 ; 0010 所述水下定位导航接收机不需要向外部发射信号, 根据接收到的基站信号, 解算 出自身位置, 并实现与基站时间同步。系统中可以有多台水下定位导航接收机同时接收导 说 明 书 CN 103823205 A 4 2/5 页 5 航信号, 其数量不受限制。 0011 优选地, 所述基站布置在水面、 水中或水底。基站的位置固定或者移动均可。 0012 优选地, 所述基站的导航信号采用双极性二进制编码, 即其取值为 +1 或 -1, 分别 对应二进制的 0 和 1, 导航信号包含测距码、 导航电文信息 : 0013 所述测距码是一组长度固定的伪随机码, 其长度为PZ,。
15、 周期为PP。 每个基站对应一 个特定序列的伪随机码, 记为 Pi, 不同的 Pi相互准正交, 即它们的互相关函数的峰值 PCMi与 自相关函数的峰值 PCSi之间的关系满足 0014 根据测距码 Pi即可确定其对应的基站 Si; 0015 所述导航电文包含基站时间, 基站位置信息, 导航电文的每个二进制位的长度为 测距码周期 PP的整数倍。 0016 根据本发明的第二方面, 提供一种水下定位导航方法, 该方法包含 : 基站发射导航 信号、 水下定位导航接收机接收基站信号并进行定位导航解算 ; 0017 所述基站发射导航信号, 具体如下 : 0018 生成导航电文, 记为 Di, 导航电文由同。
16、步帧和信息帧组成, 同步帧是一组固定的 二进制数据, 记为 T ; 信息帧包含了基站时间和基站位置坐标 ; 0019 利用测距码作为扩频码, 对导航电文进行扩频, 得到扩频信号, 记为 Ki, Ki DiPi; 0020 利用扩频后的信号 Ki, 对载波进行调制, 所有基站时间同步, 可以实现载波同 步, 即所有基站的载波频率相位同步, 记为 C, 导航信号记为 Xi, Xi CKi CDiPi; 0021 将导航信号 Xi通过基站的水声换能器发射到水中 ; 0022 所述水下定位导航接收机接收基站信号并进行定位导航解算, 具体如下 : 0023 定位导航接收机在水下, 其坐标为 Rci (x。
17、,y,z), 与基站之间的距离为 开始的时候, 接收机的时间 (记为 t) , 与基站时间 t0不 同步, 其时间差为 t t0-t。接收到基站发射的导航信号, 记为 Y。系统中有多个基站, 接收到的信号 Y 包含了多个基站发射的信号, 然后进行定位导航解算。 0024 与现有技术相比, 本发明具有如下的有益效果 : 0025 本发明通过以上方法, 水下定位导航接收机获得了自身相对于基站的位置坐标, 并得了与基站的时间差, 实现了时间同步。水下定位导航接收机不需要向外发射信号。水 下定位导航接收机数量不受限制。 附图说明 0026 通过阅读参照以下附图对非限制性实施例所作的详细描述, 本发明的。
18、其它特征、 目的和优点将会变得更明显 : 0027 图 1 是本发明一实施例的系统原理框图。 0028 图 2 是本发明一实施例的系统架构图。 0029 图 3 是本发明一实施例中基站的原理框图。 0030 图 4 是本发明一实施例中水下定位导航接收机的原理框图。 说 明 书 CN 103823205 A 5 3/5 页 6 具体实施方式 0031 下面结合具体实施例对本发明进行详细说明。 以下实施例将有助于本领域的技术 人员进一步理解本发明, 但不以任何形式限制本发明。 应当指出的是, 对本领域的普通技术 人员来说, 在不脱离本发明构思的前提下, 还可以做出若干变形和改进。 这些都属于本发明。
19、 的保护范围。 0032 如图 1 所示, 为本发明一实施例的定位导航系统框图, 由 4 个基站 11、 12、 13、 14 和 1 个水下定位导航接收机 15 组成。基站记为 Si, 其中 i 1,2,m。其中, m 为基站数量, m 4。下文中, i,m 含义相同。基站的位置坐标分别 Sci (xi,yi,zi)。基站布置在水面、 水中或者水底。基站之间的时钟同步, 记为 t0。基站以声波的形式向水中广播发射导航信 号。导航信号采用双极性二进制编码, 即其取值为 +1 或 -1, 分别对应二进制的 0 和 1。 0033 导航信号包含以下信息。 0034 测距码。测距码是一组长度固定的伪。
20、随机码, 其长度为 PZ, 周期为 PP。每个基站 对应一个特定序列的伪随机码, 记为 Pi。不同的 Pi相互准正交, 即它们的互相关函数的峰 值 PCMi与自相关函数的峰值 PCSi之间的关系满足 0035 根据测距码 Pi即可确定其对应的基站 Si。 0036 2导航电文。 导航电文包含基站时间, 基站位置信息。 导航电文的每个二进制位的 长度为测距码周期 PP的整数倍。 0037 基站发射导航信号的方式如下 : 0038 生成导航电文。记为 Di。导航电文由同步帧和信息帧组成。同步帧是一组固定 的二进制数据, 记为 T。信息帧包含了基站时间和基站位置坐标。 0039 利用测距码作为扩频码。
21、, 对导航电文进行扩频, 得到扩频信号, 记为 Ki。Ki DiPi。 0040 利用扩频后的信号 Ki, 对载波进行调制。所有基站时间同步, 可以实现载波同 步, 即所有基站的载波频率相位同步, 记为 C, 导航信号记为 Xi, Xi CKi CDiPi。 0041 将导航信号 Xi通过基站的水声换能器发射到水中。 0042 定位导航接收机在水下, 其坐标为 Rci (x,y,z), 与基站之间的距离为 开始的时候, 接收机的时间 (记为 t) , 与基站时间 t0不 同步, 其时间差为 t t0-t。接收到基站发射的导航信号, 记为 Y。系统中有多个基站, 接收到的信号 Y 包含了多个基站。
22、发射的信号。 0043 图2是另一实施例的系统架构图。 4个基站21、 22、 23、 24放置在水底, 利用水底电 缆 26 实现基站之间的时间同步。定位导航接收机 25 安装在载体上 (水下潜航器) , 跟随载 体运动。 0044 图3是另一实施例中基站原理框图。 本实施例中, 基站主要由发射换能器31、 阻抗 匹配器 32、 功率放大器 33、 AD 转换器 34、 嵌入式系统 35 组成。 0045 嵌入式系统 35 实现测距码、 导航电文、 载波和导航信号的计算与生成。 0046 AD 转换器 34 将导航信号由数字形式转换为模拟形式。 说 明 书 CN 103823205 A 6 。
23、4/5 页 7 0047 功率放大器33、 阻抗匹配器32和发射换能器31依次将模拟导航信号放大、 阻抗匹 配并发射到水中。 0048 图 4 是另一实施例中水下定位导航接收机原理框图。本实施例中, 水下定位导航 接收机主要由接收换能器 41、 滤波放大器 42, AD 转换器 43 和嵌入式系统 44 组成。 0049 接收换能器41将声波信号转换为电信号, 经过滤波放大器42滤除干扰信号, 再由 AD 转换器 43 将模拟电信号转换为数字信号。 0050 嵌入式系统 44 对数字信号进行处理, 实现测距码分离、 跟踪、 帧同步伪距测量、 位 置时间解算等。 0051 本实施例中, 按照以下。
24、方法进行定位导航解算 : 0052 信号解调分离。 利用码测距码Pi的正交性, 将各个基站的信号解调并分离出来。 具体方法是, 依次将各个测距码 Pi依次与信号 Y 进行相关运算。如果相关运算的结果大于 设定的阈值 (阈值根据互相关函数的峰值 PCMi选取) , 则该路信号对应了第 i 个基站发射, 经 过水体传播后, 被接收机接收到的信号, 记为 Yi。 0053 信号跟踪。实现信号分离之后, 对各路信号 Yi分别跟踪。方法是在 t 时刻, 将 信号 Yi依次与对应的测码 Pi进行相关运算, 测出相关峰值相对于的开始位置的时间, 称为 码相位 0054 帧同步及导航电文解析。接收到的信号 Y。
25、i与同步帧 T 比对, 确定导航电文的开 始时刻, 记为 tSi, 从 tSi时刻开始, 对测距码进行整周期计数, 计数值记为 Ni。依次对导航电 文进行解析, 得到基站位置和基站时间。 0055 伪距测量。利用从帧同步开始的计数值 Ni和码相位可以计算出导航信号从 基站 Si到接收机的传播时间 Ti,根据声波在水中的传播速度 c 可以计算基 站 Si到接收机的伪距 Li, Li cTi。传播时间 Ti包含了接收机与基站的时间差 t, 所以 伪距 Li不是基站 Si到接收机之间的实际距离 LSi, 其关系为 : Li LSi+ct。 0056 定位解算。 水下定位导航接收机接收到一个基站的信号。
26、, 即可得到一个伪距。 接 收到全部 m 个基站信号之后, 即可获得 m 个伪距方程, 组成如下方程组 0057 0058 以上方程组有 4 个未知数 : x,y,z,t。方程组中独立方程的个数 m 4, 求解方 程组, 得获得接收机的位置坐标x,y,z以及与基站的时间差t。 利用t对接收机时间进 行修正, 即可实现接收机时间 t 与基站时间 t0同步。 0059 当基站个数m4时, 水下定位导航接收机不需要接收到全部基站的信号, 只需要 接收到 4 个基站的信号即可。水下定位接收机数量不限。基站的绝对位置或者相对位置已 知, 基站之间保持时钟同步。 0060 本发明中, 基站以声波的形式, 。
27、向水下发射导航信号, 信号调制模式采用扩频通信 模式。水下定位接收机不需要发射任何信号。在静默隐蔽的条件下, 通过接收基站的导航 说 明 书 CN 103823205 A 7 5/5 页 8 信号, 确定自身相对于基站的位置, 从而实现水下定位导航。 水下定位接收机通过接收基站 的声波信号, 可是实现与基站时间同步。 0061 应用本发明, 可以实现水下设备 (例如水下机器人、 水下潜航器) 在隐蔽情况下 (即 水下设备不需要向外界发射信号) , 实现自主定位, 同时实现基站时间同步, 可以应用于水 下施工、 水下勘察、 水下安保、 水下监视及水下导航制导等领域。 0062 以上为本发明的部分实施例, 尽管本发明的内容已经通过上述部分实施例作了详 细介绍, 但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读 了上述内容后, 对于本发明的多种修改和替代都将是显而易见的。 因此, 本发明的保护范围 应由所附的权利要求来限定。 说 明 书 CN 103823205 A 8 1/2 页 9 图 1 图 2 说 明 书 附 图 CN 103823205 A 9 2/2 页 10 图 3 图 4 说 明 书 附 图 CN 103823205 A 10 。