移动sink的平滑路径规划方法以及装置与流程

文档序号:11846294阅读:来源:国知局

技术特征:

1.一种移动sink的平滑路径规划方法,其特征在于,包括以下步骤:

S100:在监测区域部署一定数目的传感器节点,并确定移动sink需要访问的多个传感器节点;

S101:获取移动sink的当前位置坐标和待所述移动sink依次访问的多个传感器节点的位置坐标;

S102:实时获取当前所述移动sink、所述第一传感器节点和所述第二传感器节点之间的第一角平分线;

S103:获取所述第一角平分线的参考点,根据参考点获取位于所述第一传感器节点的感知范围内的所述移动sink的第一平滑圆弧路径;

S104:以此类推,依次实时获取当前所述移动sink、所述第N-1传感器节点和所述第N传感器节点之间的第N-1角平分线,其中,N>2;

S105:获取所述第N-1角平分线的参考点,根据参考点获取位于所述第N-1传感器节点的感知范围内的所述移动sink的第N-1平滑圆弧路径。

2.根据权利要求1所述的移动sink的平滑路径规划方法,其特征在于,步骤S101具体包括:

设A1为移动sink当前所在位置,所述移动sink依次访问的传感器节点所在位置分别为A2,A3,···,An,以直线A2A3的方向为x轴的正方向建立直角坐标系,则各节点的位置坐标分别为A1(x1,y1),A2(x2,y2),A3(x3,y3),···,An(xn,yn)。

3.根据权利要求2所述的移动sink的平滑路径规划方法,其特征在于,步骤S102具体包括:

若直线A2A1的方向的斜率存在确定值;

在∠A1A2A3的角平分线A2A0上取一个参考点A0,设A0的坐标为A0(x0,y0),直线A2A1的斜率K,角平分线A2A0的斜率为K',则K与K'满足以下关系:

<mrow> <mi>K</mi> <mo>=</mo> <mfrac> <mrow> <mn>2</mn> <msup> <mi>K</mi> <mo>&prime;</mo> </msup> </mrow> <mrow> <mn>1</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>K</mi> <mo>&prime;</mo> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

由公式(1)可以求解出或者由此可以得到角平分线A2A0方程为:

<mrow> <mi>y</mi> <mo>=</mo> <msup> <mi>K</mi> <mo>&prime;</mo> </msup> <mi>x</mi> <mo>=</mo> <mfrac> <mrow> <mo>-</mo> <mn>1</mn> <mo>+</mo> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msup> <mi>K</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> <mi>K</mi> </mfrac> <mi>x</mi> <mo>.</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

4.根据权利要求3所述的移动sink的平滑路径规划方法,其特征在于,步骤S103还包括:

将所述第一角平分线与所述移动sink的第一平滑圆弧路径的交叉点C点落于被访问传感器节点A2的感知范围以内,使直线A2C的长度小于传感器节点A2的感知半径r,则直线A2C的长度需满足公式(3):

<mrow> <mover> <mrow> <msub> <mi>A</mi> <mn>2</mn> </msub> <msub> <mi>A</mi> <mn>0</mn> </msub> </mrow> <mo>&OverBar;</mo> </mover> <mo>-</mo> <mover> <mrow> <msub> <mi>A</mi> <mn>0</mn> </msub> <mi>C</mi> </mrow> <mo>&OverBar;</mo> </mover> <mo>=</mo> <msqrt> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mfrac> <mrow> <msub> <mi>Kx</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msup> <mi>K</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mo>,</mo> <mi>a</mi> <mo>&Element;</mo> <mo>&lsqb;</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

其中,参数a的变化范围从0到1,调整a能够使直线A2C的长度小于感知半径r,并使得移动sink在传感器节点A2的感知范围内的移动过程中完成数据采集;

同时,参考点A0的坐标满足以下式子:

<mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>=</mo> <mfrac> <mrow> <mo>-</mo> <mn>1</mn> <mo>+</mo> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msup> <mi>K</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> <mi>K</mi> </mfrac> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

根据公式(3)和公式(4)可以求解出参考点A0的坐标值,以参考点A0为圆心,以直线A0C为半径构建移动sink落入在坐标系内的平滑圆弧路径。

5.根据权利要求4所述的移动sink的平滑路径规划方法,其特征在于,步骤S102还包括:

当直线A2A1垂直A2A3时,直线A2A1的斜率K为无穷大,A1的坐标为(0,y1),参考点A0的x和y的坐标值相等,即x0=y0

步骤S103还包括:将所述第一角平分线与所述移动sink的第一平滑圆弧路径的交叉点C点落于被访问传感器节点A2的感知范围以内,使直线A2C的长度小于传感器节点A2的感知半径r,则直线A2C的长度需满足公式(5):

<mrow> <mover> <mrow> <msub> <mi>A</mi> <mn>2</mn> </msub> <msub> <mi>A</mi> <mn>0</mn> </msub> </mrow> <mo>&OverBar;</mo> </mover> <mo>-</mo> <mover> <mrow> <msub> <mi>A</mi> <mn>0</mn> </msub> <mi>C</mi> </mrow> <mo>&OverBar;</mo> </mover> <mo>=</mo> <mrow> <mo>(</mo> <msqrt> <mn>2</mn> </msqrt> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mo>,</mo> <mi>a</mi> <mo>&Element;</mo> <mo>&lsqb;</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

其中,参数a的变化范围从0到1,调整a能够使直线A2C的长度小于感知半径r,并使得移动sink在传感器节点A2的感知范围内的移动过程中完成数据采集;

根据参考点A0的x和y的坐标值相等和公式(5)可求出参考点A0的坐标值;以参考点A0为圆心,A0C为半径构建移动sink落入在坐标系内的平滑圆弧路径。

6.一种移动sink的平滑路径规划装置,其特征在于,具体包括:

节点部署模块,用于在监测区域部署一定数目的传感器节点,并确定移动sink需要访问的多个传感器节点;

坐标获取模块,用于获取移动sink的当前位置坐标和待所述移动sink依次访问的多个传感器节点的位置坐标;

平分线获取模块,用于实时获取当前所述移动sink、所述第一传感器节点和所述第二传感器节点之间的第一角平分线;

路径获取模块,用于获取所述第一角平分线的参考点,根据参考点获取位于所述第一传感器节点的感知范围内的所述移动sink的第一平滑圆弧路径;

其中,以此类推,依次实时获取当前所述移动sink、所述第N-1传感器节点和所述第N传感器节点之间的第N-1角平分线,其中,N>2;所述路径获取模块获取所述第N-1角平分线的参考点,根据参考点获取位于所述第N-1传感器节点的感知范围内的所述移动sink的第N-1平滑圆弧路径。

7.根据权利要求6所述的移动sink的平滑路径规划装置,其特征在于,所述坐标获取模块具体包括:

设A1为移动sink当前所在位置,所述移动sink依次访问的传感器节点所在位置分别为A2,A3,···,An,以直线A2A3的方向为x轴的正方向建立直角坐标系,则各节点的位置坐标分别为A1(x1,y1),A2(x2,y2),A3(x3,y3),···,An(xn,yn)。

8.根据权利要求7所述的移动sink的平滑路径规划装置,其特征在于,所述角平分线获取模块具体包括二种情况:

第一种情况:直线A2A1方向的斜率存在确定值;

在∠A1A2A3的角平分线上取一个参考点A0,设A0的坐标为A0(x0,y0),求出直线A2A1的斜率K,同理可以设角平分线A2A0的斜率为K',则K与K'满足以下关系:

<mrow> <mi>K</mi> <mo>=</mo> <mfrac> <mrow> <mn>2</mn> <msup> <mi>K</mi> <mo>&prime;</mo> </msup> </mrow> <mrow> <mn>1</mn> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>K</mi> <mo>&prime;</mo> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>

由公式(6)可以求解出或者由此可以得到角平分线A2A0方程为:

<mrow> <mi>y</mi> <mo>=</mo> <msup> <mi>K</mi> <mo>&prime;</mo> </msup> <mi>x</mi> <mo>=</mo> <mfrac> <mrow> <mo>-</mo> <mn>1</mn> <mo>+</mo> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msup> <mi>K</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> <mi>K</mi> </mfrac> <mi>x</mi> <mo>.</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

9.根据权利要求8所述的移动sink的平滑路径规划装置,其特征在于,所述路径获取模块具体包括:

将所述第一角平分线与所述移动sink的第一平滑圆弧路径的交叉点C点落于被访问传感器节点A2的感知范围以内,使直线A2C的长度小于传感器节点A2的感知半径r,则直线A2C的长度需满足公式(8):

<mrow> <mover> <mrow> <msub> <mi>A</mi> <mn>2</mn> </msub> <msub> <mi>A</mi> <mn>0</mn> </msub> </mrow> <mo>&OverBar;</mo> </mover> <mo>-</mo> <mover> <mrow> <msub> <mi>A</mi> <mn>0</mn> </msub> <mi>C</mi> </mrow> <mo>&OverBar;</mo> </mover> <mo>=</mo> <msqrt> <mrow> <msup> <msub> <mi>x</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mn>0</mn> </msub> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mfrac> <mrow> <msub> <mi>Kx</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msup> <mi>K</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mo>,</mo> <mi>a</mi> <mo>&Element;</mo> <mo>&lsqb;</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>

其中,参数a的变化范围从0到1,调整a能够使直线A2C的长度小于感知半径r,并使得移动sink在传感器节点A2的感知范围内的移动过程中完成数据采集;

同时,参考点A0的坐标满足以下式子:

<mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>=</mo> <mfrac> <mrow> <mo>-</mo> <mn>1</mn> <mo>+</mo> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msup> <mi>K</mi> <mn>2</mn> </msup> </mrow> </msqrt> </mrow> <mi>K</mi> </mfrac> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>

根据公式(8)和公式(9)可以求解出参考点A0的坐标值,以参考点A0为圆心,以直线A0C为半径构建移动sink落入在坐标系内的平滑圆弧路径。

10.根据权利要求8所述的移动sink的平滑路径规划装置,其特征在于,所述平分线获取模块还包括:

第二种情况:直线A2A1垂直直线A2A3时,直线A2A1的斜率K为无穷大,即A1的坐标为(0,y1),参考点A0的x和y的坐标值相等,即x0=y0

所述路径获取模块还包括:将所述第一角平分线与所述移动sink的第一平滑圆弧路径的交叉点C点落于被访问传感器节点A2的感知范围以内,使直线A2C的长度小于传感器节点A2的感知半径r,则直线A2C的长度需满足公式(10):

<mrow> <mover> <mrow> <msub> <mi>A</mi> <mn>2</mn> </msub> <msub> <mi>A</mi> <mn>0</mn> </msub> </mrow> <mo>&OverBar;</mo> </mover> <mo>-</mo> <mover> <mrow> <msub> <mi>A</mi> <mn>0</mn> </msub> <mi>C</mi> </mrow> <mo>&OverBar;</mo> </mover> <mo>=</mo> <mrow> <mo>(</mo> <msqrt> <mn>2</mn> </msqrt> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mo>,</mo> <mi>a</mi> <mo>&Element;</mo> <mo>&lsqb;</mo> <mn>0</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>

其中,参数a的变化范围从0到1,调整a可以使直线A2C的长度小于感知半径r,并使得移动sink在传感器节点A2的感知范围内的移动过程中完成数据采集;

根据参考点A0的x和y的坐标值相等和公式(10)可求出参考点A0的坐标值;以参考点A0为圆心,A0C为半径构建移动sink落入在坐标系内的平滑圆弧路径。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1