一种系绳式洋流发电机运动轨迹控制方法技术

一种系绳式洋流发电机运动轨迹控制方法，所述的运动轨迹为"8"字形运动轨迹，步骤如下：(1)将运动轨迹分解为两个圆弧及4个圆弧的外切线段，并将圆弧离散为顺次连接的线段，进而将整个运动轨迹区域划分为顺次且首末区相连的区位；(2)发电机在运动过程中，根据发电机当前所处的区位进行运动轨迹控制并实时判断发动机是否越过当前区位，若越过当前区位，则按照步骤(1)的顺次切换到下一个区位：若发电机处于圆弧的外切线段所在的区位时，控制发电机的航向与外切线段的方向保持一致；若发电机处于圆弧的离散线段所在的区位时，控制发电机的航向垂直于发电机当前位置到区位所处圆弧圆心的连线，且指向运动方向。

A trajectory control method for tethered ocean current generator

A method for controlling the motion trajectory of a tethered ocean current generator is described. The motion trajectory is a \8\ zigzag motion trajectory. The steps are as follows: (1) The motion trajectory is divided into two circular arcs and four circular arc tangent segments, and the circular arc is separated into sequential connected segments, and the whole motion trajectory region is divided into sequential and terminal phases. In the course of operation, the generator controls the locus of motion according to the current position of the generator and determines whether the engine has crossed the current position in real time. If the generator is in the position of the arc discrete line section, the direction of the control generator is perpendicular to the current position of the generator to the center of the arc and points to the direction of motion.

【技术实现步骤摘要】
一种系绳式洋流发电机运动轨迹控制方法
本专利技术涉及一种系绳式洋流发电机“8”字形运动轨迹控制方法。
技术介绍
系绳式洋流发电机是一种将发电涡轮挂在机翼下方，机翼通过系留绳系在一个固定锚点上，利用洋流在机翼上产生的前进方向升力分量往复运动的发电机。这种发电机的发电涡轮进口水流速度可达洋流速度的数倍，而传统的固定式洋流发电机的发电涡轮进口水流速度仅能达到洋流速度。由于发电能力与发电涡轮进口水流速度的三次方成正比，系绳式洋流发电机的发电能力与固定式洋流发电机相比发电能力极大提高，且在低速洋流下的起动能力较强。如何控制发电机在洋流中往复运动，从而持续产生数倍于洋流速度的运动速度和涡轮进口水流速度，是系绳式洋流发电机的关键技术。为避免往复运动时系留绳发生自缠绕，可控制发电机在洋流中以“8”字形轨迹运动。
技术实现思路
本专利技术的技术解决问题：设计一种系绳式洋流发电机“8”字形运动轨迹控制方法。该方法逻辑简单、存储量小，便于在嵌入式系统中实现；产生的航向角指令光滑无跳变，且对初始位置和速度不敏感，运行稳定、鲁棒性强。本专利技术的技术方案：一种系绳式洋流发电机运动轨迹控制方法，所述的运动轨迹为"8"字形运动轨迹，步骤如下：(1)将运动轨迹分解为两个圆弧及4个圆弧的外切线段，并将圆弧离散为顺次连接的线段，进而将整个运动轨迹区域划分为顺次且首末区相连的区位；(2)发电机在运动过程中，根据发电机当前所处的区位进行运动轨迹控制并实时判断发动机是否越过当前区位，若越过当前区位，则按照步骤(1)的顺次切换到下一个区位：若发电机处于圆弧的外切线段所在的区位时，控制发电机的航向与外切线段的方向保持一致；若发电机处于圆弧的离散线段所在的区位时，控制发电机的航向垂直于发电机当前位置到区位所处圆弧圆心的连线，且指向运动方向。进一步的，按照发电机运动方向，通过步骤(1)中每条线段终点的垂线将整个运动轨迹区域划分为顺次且首末区相连的区位。进一步的，步骤(1)中将圆弧离散为顺次连接的线段要求与圆弧的外切线段相连接的圆弧离散线段与圆弧的外切线段设计在一条直线上。进一步的，步骤(1)中将圆弧离散为顺次连接的线段中离散的每个线段对应的圆心角为15-45°。进一步的，步骤(1)中圆弧半径长度与该圆弧的外切线段长度的比为0.1-1。进一步的，步骤(1)中两个圆弧半径长度的比为0.1-10。进一步的，同一个圆弧的两个外切线段的长度比为0.5-2。进一步的，通过判断发电机是否越过当前区位线段终点的垂线来判断是否越过当前区位。进一步的，判断由当前区位线段终点指向发电机位置的矢量，与当前区位线段终点指向线段起点的矢量的点积，若为负则已越过当前区位，若非负则仍处于当前区位。进一步的，通过跟踪航向角指令实现发电机运动轨迹的控制，其中不同区位的航向角指令通过下述方式计算：令，psiC为航向角指令，假设P位于PnPn+1区位，则当PnPn+1区位为圆弧的外切线段所在的区位时，psiC＝arctan2(Pn+1y-Pny,Pn+1z-Pnz)(2)psiC计算方式如式(2)所示，其中Pny，Pnz分别为点Pn的y坐标和z坐标；当PnPn+1区位为圆弧离散线段所在的区位且发电机运动方向为顺时针方向时，psiC＝π-arctan2(Pz,Py-O1y)(3)Py，Pz分别为点P的y坐标和z坐标，O1y为当前区位所在圆弧圆心的y坐标；当PnPn+1区位为圆弧离散线段所在的区位且发电机运动方向为逆时针方向时，psiC＝-arctan2(Pz,Py-O2y)(4)O2y为当前区位所在圆弧圆心的y坐标；若式(2)～式(4)计算出的psiC为负，应如式(5)所示对psiC进行处理：psiC＝psiC+2π(5)。本专利技术与现有技术相比的优点如下：本方法将“8”字形运动轨迹设计为2个圆弧及4个圆弧的切线段，并将圆弧离散为顺次连接的线段；在发电机运动过程中，通过计算发电机与这组线段的区位关系来确定和切换发电机的航向指令；通过设计线段间的角度关系来保证航向指令切换时光滑无跳变。本方法逻辑简单、存储量小，便于在嵌入式系统中实现；产生的航向角指令光滑无跳变，且对初始位置和速度不敏感，运行稳定、鲁棒性强。附图说明图1“8”字形运动轨迹与其离散线段示意图图2“8”字形实际轨迹示意图图3“8”航向角指令示意图具体实施方式本专利技术涉及一种系绳式洋流发电机"8"字形运动轨迹控制方法，步骤如下：(1)将"8"字型运动轨迹设计为两个圆弧及4个圆弧的外切线段，并将圆弧离散为顺次连接的线段；圆弧的外切线段的垂线、圆弧的离散线段终点的垂线将轨迹附近区域划分为顺次连接的区位，且末区位与首区位相连；为了避免航向角指令切换时的跳变，与圆弧的外切线段相连接的圆弧离散线段须与圆弧的外切线段设计在一条直线上，这样不论发电机按照怎样的方向开始运动，都能避免航向指令的跳变。当然若预先设定好发电机的运动方向，则只需要将由圆弧线段运动到外切线段方向的与圆弧的外切线段相连接的圆弧离散线段与圆弧的外切线段设计在一条直线上即可。上述将圆弧离散为顺次连接的线段中离散的每个线段对应的圆心角为15-45°。(2)发电机在运行过程中，计算发电机与上述各组线段的区位关系来确定和切换发电机的航向角指令：具体通过判断是否越过当前区位线段终点的垂线来判断是否越过该区位，越过该区位则切换到下一区位。越过末区位时则切换到首区位，具体的：判断由当前区位线段终点指向发电机位置的矢量，与当前区位线段终点指向线段起点的矢量的点积，若为负则已越过当前区位，若非负则仍处于当前区位。通过判断发电机当前所处区位，对发电机进行控制，具体的：当发电机位于圆弧的外切线段区位时，发电机的航向与外切线段的方向保持一致；当发电机位于圆弧的离散线段区位时，发电机的航向垂直于发电机当前位置到所处圆弧圆心的连线。实施例图1给出了“8”字形运动轨迹与其离散线段在zoy坐标系中的示意，其中，y坐标方向为平行于两个圆弧圆心连线的方向。设计“8”字形运动轨迹由圆弧P2P6P10、圆弧P12P16P20、线段P1P2、P1P10、P1P12、P1P20组成。其中P1P2、P1P10是圆弧P2P6P10的切线段，切点分别为P2、P10；P1P12、P1P20是圆弧P12P16P20的切线段，切点分别为P12、P20。将圆弧P2P6P10和圆弧P12P16P20分别离散成若干顺次连接的线段。本例中，将圆弧P2P6P10离散为P2P3、P3P4、...、P9P10共8条线段，同样将圆弧P12P16P20离散为P12P13、P13P14、...、P19P20共8条线段。其中，应保持与圆弧的切线段相连接的圆弧离散线段与切线段在一条直线上，本例中，保持P2P3与P1P2在一条直线、P9P10与P10P11在一条直线、P12P13与P11P12在一条直线、P19P20与P20P21在一条直线，这里点P1、P11、P21是重合的点。当然若按照图3所示的运动方向，只需将P9P10与P10P11设计在一条直线、P19P20与P20P21设计在一条直线即可满足航向角指令防跳变要求。虚线A2B2与线段P1P2垂直，并通过P1P2的终点P2，同理，虚线A3B3与线段P2P3垂直，并通过P2P3的终点P3、...、虚线A10B10本文档来自技高网...

【技术保护点】
1.一种系绳式洋流发电机运动轨迹控制方法，所述的运动轨迹为"8"字形运动轨迹，其特征在于步骤如下：(1)将运动轨迹分解为两个圆弧及4个圆弧的外切线段，并将圆弧离散为顺次连接的线段，进而将整个运动轨迹区域划分为顺次且首末区相连的区位；(2)发电机在运动过程中，根据发电机当前所处的区位进行运动轨迹控制并实时判断发动机是否越过当前区位，若越过当前区位，则按照步骤(1)的顺次切换到下一个区位：若发电机处于圆弧的外切线段所在的区位时，控制发电机的航向与外切线段的方向保持一致；若发电机处于圆弧的离散线段所在的区位时，控制发电机的航向垂直于发电机当前位置到区位所处圆弧圆心的连线，且指向运动方向。

【技术特征摘要】
1.一种系绳式洋流发电机运动轨迹控制方法，所述的运动轨迹为"8"字形运动轨迹，其特征在于步骤如下：(1)将运动轨迹分解为两个圆弧及4个圆弧的外切线段，并将圆弧离散为顺次连接的线段，进而将整个运动轨迹区域划分为顺次且首末区相连的区位；(2)发电机在运动过程中，根据发电机当前所处的区位进行运动轨迹控制并实时判断发动机是否越过当前区位，若越过当前区位，则按照步骤(1)的顺次切换到下一个区位：若发电机处于圆弧的外切线段所在的区位时，控制发电机的航向与外切线段的方向保持一致；若发电机处于圆弧的离散线段所在的区位时，控制发电机的航向垂直于发电机当前位置到区位所处圆弧圆心的连线，且指向运动方向。2.根据权利要求1所述的方法，其特征在于：按照发电机运动方向，通过步骤(1)中每条线段终点的垂线将整个运动轨迹区域划分为顺次且首末区相连的区位。3.根据权利要求1所述的方法，其特征在于：步骤(1)中将圆弧离散为顺次连接的线段要求与圆弧的外切线段相连接的圆弧离散线段与圆弧的外切线段设计在一条直线上。4.根据权利要求1或3所述的方法，其特征在于：步骤(1)中将圆弧离散为顺次连接的线段中离散的每个线段对应的圆心角为15-45°。5.根据权利要求1所述的方法，其特征在于：步骤(1)中圆弧半径长度与该圆弧的外切线段长度的比为0.1-1。6.根据权利要求1所述的方法，其特征在于：步骤(1)中两个圆弧半径长度的比为0.1-10。7.根据权利要求...

【专利技术属性】
技术研发人员：刘哲，韩国玺，赵怡，周月荣，关发明，罗小云，
申请(专利权)人：中国航天空气动力技术研究院，
类型：发明
国别省市：北京,11