CN107169176B - 移动舞台运动模式的切换及其控制方法 - Google Patents
移动舞台运动模式的切换及其控制方法 Download PDFInfo
- Publication number
- CN107169176B CN107169176B CN201710286679.9A CN201710286679A CN107169176B CN 107169176 B CN107169176 B CN 107169176B CN 201710286679 A CN201710286679 A CN 201710286679A CN 107169176 B CN107169176 B CN 107169176B
- Authority
- CN
- China
- Prior art keywords
- moving stage
- motion
- stage
- track
- driving wheel
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 239000011159 matrix material Substances 0.000 claims description 19
- 230000007246 mechanism Effects 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 11
- 230000008676 import Effects 0.000 claims description 9
- 238000000354 decomposition reaction Methods 0.000 claims description 8
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 7
- 230000006870 function Effects 0.000 claims description 5
- 230000007547 defect Effects 0.000 abstract description 2
- 238000011217 control strategy Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/17—Mechanical parametric or variational design
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Geometry (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Medical Informatics (AREA)
- Automation & Control Theory (AREA)
- Software Systems (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
- External Artificial Organs (AREA)
- Toys (AREA)
Abstract
本发明公开了一种移动舞台运动模式的切换及其控制方法,包括以下步骤:1)根据欧拉运动学方程及运动学原理建立移动舞台的运动学模型;2)其次,对应不同的运动模式,设计不同的控制方法。本发明是为了克服现有技术中的移动舞台无法满足曲线运动并同时完成旋转的需要,提供了移动舞台运动模式的切换及其控制方法,可有效满足演出艺术多样化展示的需要。
Description
技术领域
本发明应用于舞台控制技术领域,涉及到移动舞台不同运动模式的切换,尤其是针对移动舞台不同运动模式的切换,提出了一种简单有效的控制方法。
背景技术
现代演出中,为了更好达到艺术效果,需要控制全向移动型舞台配合演员进行演出。全向移动舞台是一种四个全向轮耦合而成的全向移动平台,根据动力与转向控制需求共有八个电机组成,每个驱动轮上有独立的动力源,每个轴上均有独立的转向机构。这种结构的移动舞台具有转向半径小、转向稳定容易等特点,尤其适用于演出中复杂场景的布景需求。
但针对现有的移动舞台,同一时刻只能实现曲线运动或者旋转运动,运动模式简单,无法满足现代舞台演出多样化的要求。
发明内容
本发明是为了克服现有技术中的移动舞台无法满足曲线运动并同时完成旋转的需要,提供了移动舞台运动模式的切换及其控制方法,可有效满足演出艺术多样化展示的需要。
本发明解决其技术问题所采用的技术方案:
移动舞台运动模式的切换及其控制方法,所述方法包括以下过程:
步骤1)建立移动舞台的运动学模型:
移动舞台的结构比较复杂,要想对其实现有效的控制进而实现复杂的运动方式,首先要建立合理的运动学模型。移动舞台的位姿由三量(x,y,θ)描述。建立移动舞台的运动学模型,驱动轮的切线方向的速度分量,见表达式(1)
其中
vnT,n=1、2、3、4--驱动轮切线方向速度分量
x--移动舞台在世界坐标系X轴的坐标值
y--移动舞台在世界坐标系Y轴的坐标值
θ--移动舞台在世界坐标系中的旋转角
θ0--车体对角和侧边的夹角(对于结构固定的车体,θ0为某一定值)
R--车体质心到转向结构旋转中心的距离
r--转向结构的旋转半径
wn,n=1、2、3、4--转向机构的旋转角速度
ρn,n=1、2、3、4--转向机构与车体坐标系X轴的夹角
驱动轮的法线方向速度分量,见表达式(2)
viN,i=1、2、3、4--驱动轮法线方向速度分量
步骤2)设计控制方法,过程包括:
驱动轮为普通轮子,故不管移动舞台做何种运动,须保证轮子法线方向的速度分量为零。
1)曲线运动
移动舞台单纯做曲线运动时,驱动轮的法线方向速度分量,见表达式(3)
以第二驱动轮为例,有
只要令
即可保证v2N恒为零。同理可类推到其他轮子。
2)旋转运动
移动舞台单纯做旋转运动时,驱动轮的法线方向速度分量,见表达式(4)
以第二驱动轮为例,有
只要令
即可保证v2N恒为零。同理可类推到其他轮子。
3)曲线+旋转运动
移动舞台做曲线+旋转运动时,驱动轮的法线方向速度分量,见表达式(3)
以第二驱动轮为例,有
只要满足
即可保证v2N恒为零。同理可类推到其他轮子。
与现有技术相比,本发明的优点在于:针对现有技术的移动舞台只能实现曲线运动或者旋转运动的模式,使用简单有效的控制策略扩展了移动舞台的运动模式,丰富了演出的多样化。
本发明主要执行部分在移动舞台控制计算机上运行实施。本方法应用过程可以大致分为3个阶段:
1、轨迹设置:在轨迹导入界面中,设定好运动轨迹。导入轨迹确认后,由控制计算机将预设轨迹数据存入Flash存储单元中,通过控制计算机将预设轨迹分解为矩阵(均是时间t的函数)并将数据存入Flash存储单元中保存。
2、参数设置:在参数导入界面中,输入式(1)中r、R、θ0值。根据预设轨迹分解得到的矩阵设定ρ1,ρ2,ρ3,ρ4的初始值以及w1,w2,w3,w4的值;输入参数确认后,由控制计算机将设置数据送入计算机存储单元Flash中保存。ρ1,ρ2,ρ3,ρ4的初始值以及w1,w2,w3,w4的值设定规则如下(初始θ=0):(1)若则初始时刻
3、在线运行:点击组态界面“运行”按钮,移动舞台的控制计算机从Flash存储中读取参数设置时导入的参数,并从Flash存储中读取经过轨迹分解之后矩阵的数据,执行“移动舞台运动控制程序”,通过读取导入的设置参数,控制转向机构的初始角度及转向电机的转速,实现移动舞台不同运动模式的自动切换。
附图说明
图1是移动舞台结构示意图;
具体实施方式
为了使本发明的技术方案、设计思路能更加清晰,下面再进行详尽的描述。
移动舞台运动模式的切换及其控制方法,所述方法包括以下过程:
步骤1)建立移动舞台的运动学模型:
移动舞台的结构比较复杂,要想对其实现有效的控制进而实现复杂的运动方式,首先要建立合理的运动学模型。移动舞台的位姿由三量(x,y,θ)描述。建立移动舞台的运动学模型,驱动轮的切线方向的速度分量,见表达式(1)
其中
vnT,n=1、2、3、4--驱动轮切线方向速度分量
x--移动舞台在世界坐标系X轴的坐标值
y--移动舞台在世界坐标系Y轴的坐标值
θ--移动舞台在世界坐标系中的旋转角
θ0--车体对角和侧边的夹角(对于结构固定的车体,θ0为某一定值)
R--车体质心到转向结构旋转中心的距离
r--转向结构的旋转半径
wn,n=1、2、3、4--转向机构的旋转角速度
ρn,n=1、2、3、4--转向机构与车体坐标系X轴的夹角
驱动轮的法线方向速度分量,见表达式(2)
viN,i=1、2、3、4--驱动轮法线方向速度分量。
步骤2)设计控制方法,过程包括:
驱动轮为普通轮子,故不管移动舞台做何种运动,须保证轮子法线方向的速度分量为零。
1)曲线运动
移动舞台单纯做曲线运动时,驱动轮的法线方向速度分量,见表达式(3)
以第二驱动轮为例,有
只要令
即可保证v2N恒为零。同理可类推到其他轮子。
2)旋转运动
移动舞台单纯做旋转运动时,驱动轮的法线方向速度分量,见表达式(4)
以第二驱动轮为例,有
只要令
即可保证v2N恒为零。同理可类推到其他轮子。
3)曲线+旋转运动
移动舞台做曲线+旋转运动时,驱动轮的法线方向速度分量,见表达式(3)
以第二驱动轮为例,有
只要满足
即可保证v2N恒为零。同理可类推到其他轮子。
与现有技术相比,本发明的优点在于:针对现有技术的移动舞台只能实现曲线运动或者旋转运动的模式,使用简单有效的控制策略扩展了移动舞台的运动模式,丰富了演出的多样化。
实施例1为移动舞做曲线运动的过程,具体操作过程:
2、在参数设置界面中,输入移动舞台的运动学模型基本参数,如下:
则初始时刻
3、在线运行:点击组态界面“运行”按钮,移动舞台的控制计算机从Flash存储中读取参数设置时导入的参数,并从Flash存储中读取经过轨迹分解之后矩阵的数据,执行“移动舞台运动控制程序”,通过读取导入的设置参数,控制转向机构的初始角度及转向电机的转速,实现移动舞台不同运动模式的自动切换。
实施例2为移动舞做旋转运动的过程,具体操作过程:
2、在参数设置界面中,输入移动舞台的运动学模型基本参数,如下:
则初始时刻
3、在线运行:点击组态界面“运行”按钮,移动舞台的控制计算机从Flash存储中读取参数设置时导入的参数,并从Flash存储中读取经过轨迹分解之后矩阵的数据,执行“移动舞台运动控制程序”,通过读取导入的设置参数,控制转向机构的初始角度及转向电机的转速,实现移动舞台不同运动模式的自动切换。
实施例3为移动舞做旋转+曲线运动的过程,具体操作过程:
1、在轨迹导入界面中,设定好运动轨迹。本实例的设定轨迹为移动舞台沿世界坐标系x轴以0.2m/s速度做直线运动,同时以0.2rad/s做旋转运动。经过轨迹分解后得到矩阵(均是时间t的函数),矩阵参数如下:
2、在参数设置界面中,输入移动舞台的运动学模型基本参数,如下:
则初始时刻
3、在线运行:点击组态界面“运行”按钮,移动舞台的控制计算机从Flash存储中读取参数设置时导入的参数,并从Flash存储中读取经过轨迹分解之后矩阵的数据,执行“移动舞台运动控制程序”,通过读取导入的设置参数,控制转向机构的初始角度及转向电机的转速,实现移动舞台不同运动模式的自动切换。
以上阐述的是本发明给出的三个实施例所表示的不同运动模式下的控制方法。需要指出,上述实施例用来解释说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明做出的任何修改,都落入本发明的保护范围。
Claims (2)
1.移动舞台运动模式的切换及其控制方法,所述方法包括以下过程:
步骤1)建立移动舞台的运动学模型:
首先要建立合理的运动学模型;移动舞台的位姿由三量(x,y,θ)描述,建立移动舞台的运动学模型,驱动轮的切线方向的速度分量,见表达式(1):
其中
vnT,n=1、2、3、4--驱动轮切线方向速度分量
x--移动舞台在世界坐标系X轴的坐标值
y--移动舞台在世界坐标系Y轴的坐标值
θ--移动舞台在世界坐标系中的旋转角
θ0--车体对角和侧边的夹角,对于结构固定的车体,θ0为某一定值
R--车体质心到转向结构旋转中心的距离
r--转向结构的旋转半径
wn,n=1、2、3、4--转向机构的旋转角速度
ρn,n=1、2、3、4--转向机构与车体坐标系X轴的夹角
驱动轮的法线方向速度分量,见表达式(2)
viN,i=1、2、3、4--驱动轮法线方向速度分量
步骤2)设计控制方法,过程包括:
驱动轮为普通轮子,故不管移动舞台做何种运动,须保证轮子法线方向的速度分量为零;
1)曲线运动
移动舞台单纯做曲线运动时,驱动轮的法线方向速度分量,见表达式(3)
第二驱动轮表示如下:
只要令
即可保证v2N恒为零,同理可类推到其他轮子;
2)旋转运动
移动舞台单纯做旋转运动时,驱动轮的法线方向速度分量,见表达式(4)
第二驱动轮表示如下:
只要令
即可保证v2N恒为零,同理可类推到其他轮子;
3)曲线+旋转运动
移动舞台做曲线+旋转运动时,驱动轮的法线方向速度分量,见表达式(5)
第二驱动轮表示如下:
只要满足
即可保证v2N恒为零,同理可类推到其他轮子;
2.根据权利要求1所述的移动舞台运动模式的切换及其控制方法,其特征在于:移动舞台控制计算机上的实施过程由主要执行部分运行,主要包括以下步骤:
1)轨迹设置:在轨迹导入界面中,设定好运动轨迹;导入轨迹确认后,由控制计算机将预设轨迹数据存入Flash存储单元中,通过控制计算机将预设轨迹分解为矩阵,均是时间t的函数,并将数据存入Flash存储单元中保存;
2)参数设置:在参数导入界面中,输入式(1)中r、R、θ0值;根据预设轨迹分解得到的矩阵设定ρ1,ρ2,ρ3,ρ4的初始值以及w1,w2,w3,w4的值;输入参数确认后,由控制计算机将设置数据送入计算机存储单元Flash中保存;ρ1,ρ2,ρ3,ρ4的初始值以及w1,w2,w3,w4的值设定规则如下,初始θ=0:(1)若则初始时刻[w1 w2 w3 w4]T=[0 0 0 0]T;(2)若初始[w1 w2 w3w4]T=[0 0 0 0]T;(3)若则初始时刻
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710286679.9A CN107169176B (zh) | 2017-04-27 | 2017-04-27 | 移动舞台运动模式的切换及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710286679.9A CN107169176B (zh) | 2017-04-27 | 2017-04-27 | 移动舞台运动模式的切换及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107169176A CN107169176A (zh) | 2017-09-15 |
CN107169176B true CN107169176B (zh) | 2020-04-21 |
Family
ID=59812691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710286679.9A Active CN107169176B (zh) | 2017-04-27 | 2017-04-27 | 移动舞台运动模式的切换及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107169176B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6176495B1 (en) * | 1995-03-15 | 2001-01-23 | Wenger Corporation | Hydraulic leveling system for mobile stage vehicle |
CN102609001A (zh) * | 2012-02-17 | 2012-07-25 | 广州彩熠灯光有限公司 | 一种调节舞台灯具的控制系统及其控制方法 |
CN105701352A (zh) * | 2016-01-15 | 2016-06-22 | 中国科学院光电研究院 | 空间运动目标的轨迹预测方法 |
CN106125728A (zh) * | 2016-07-05 | 2016-11-16 | 上海电机学院 | 一种四驱轮式移动机器人轨迹跟踪控制方法 |
-
2017
- 2017-04-27 CN CN201710286679.9A patent/CN107169176B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6176495B1 (en) * | 1995-03-15 | 2001-01-23 | Wenger Corporation | Hydraulic leveling system for mobile stage vehicle |
CN102609001A (zh) * | 2012-02-17 | 2012-07-25 | 广州彩熠灯光有限公司 | 一种调节舞台灯具的控制系统及其控制方法 |
CN105701352A (zh) * | 2016-01-15 | 2016-06-22 | 中国科学院光电研究院 | 空间运动目标的轨迹预测方法 |
CN106125728A (zh) * | 2016-07-05 | 2016-11-16 | 上海电机学院 | 一种四驱轮式移动机器人轨迹跟踪控制方法 |
Non-Patent Citations (2)
Title |
---|
《基于全向轮的移动式舞台设备的设计研究》;马福东等;《机电工程》;20141231;第31卷(第12期);全文 * |
《基于嵌入式的自由式舞台车台控制系统的设计》;袁月民;《中国优秀硕士学位论文全文数据库 信息科技辑》;20141015(第10期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN107169176A (zh) | 2017-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2022021686A1 (zh) | 虚拟对象的控制方法及装置、存储介质、电子装置 | |
CA3038766C (en) | Operating method and device of plant-protection unmanned aerial vehicle | |
CN109623825B (zh) | 一种移动轨迹规划方法、装置、设备和存储介质 | |
CN108241339A (zh) | 仿人机械臂的运动求解和构型控制方法 | |
CN1198684A (zh) | 视频游戏机以及存储了视频游戏程序的媒体 | |
JP2002196660A (ja) | 疑似操舵感装置 | |
CN110333733A (zh) | 一种四旋翼飞行器的串级变论域模糊pid姿态控制系统及方法 | |
CN107169176B (zh) | 移动舞台运动模式的切换及其控制方法 | |
JPWO2017208362A1 (ja) | 3次元積層造形システム、3次元積層造形方法、積層造形制御装置およびその制御方法と制御プログラム | |
CN112873166A (zh) | 一种生成机器人肢体动作的方法、装置、电子设备及介质 | |
CN105573331B (zh) | 一种控制多旋翼飞行器翻转的方法及装置 | |
CN113608543A (zh) | 飞行器航迹自适应规划的方法、装置、设备及存储介质 | |
CN116185244A (zh) | 一种操作三维场景中物体旋转的方法、系统、装置及介质 | |
CN114872782B (zh) | 四轮全向底盘控制方法及系统 | |
CN109985383A (zh) | 一种信息处理的方法、装置、存储介质及电子装置 | |
Papachristos et al. | Linear quadratic optimal position control for an unmanned tri-tiltrotor | |
Ribeiro et al. | Make way for the robot animators! bringing professional animators and AI programmers together in the quest for the illusion of life in robotic characters | |
EP4395903A1 (en) | System and method for augmented reality for a moveable real-world object | |
CN104436694B (zh) | 一种电子玩具控制系统及控制方法 | |
CN107844292B (zh) | 一种跑酷游戏中相机曲线轨迹的控制方法及其系统 | |
Cabrera-Cósetl et al. | Self-parking system based in a fuzzy logic approach | |
Ma et al. | Studies of AR drone on gesture control | |
Belaidi et al. | IoT path planning approach for mobile robots | |
CN117968464B (zh) | 火箭的高空调姿控制方法、装置、电子设备及存储介质 | |
JP4394727B2 (ja) | 画像生成装置、ゲーム装置及び情報記憶媒体 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |