CN109039222B - 一种加速力矩受限的转台运动曲线在线规划方法及系统 - Google Patents

一种加速力矩受限的转台运动曲线在线规划方法及系统 Download PDF

Info

Publication number
CN109039222B
CN109039222B CN201810799287.7A CN201810799287A CN109039222B CN 109039222 B CN109039222 B CN 109039222B CN 201810799287 A CN201810799287 A CN 201810799287A CN 109039222 B CN109039222 B CN 109039222B
Authority
CN
China
Prior art keywords
frame
motion
speed
position information
loop
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.)
Expired - Fee Related
Application number
CN201810799287.7A
Other languages
English (en)
Other versions
CN109039222A (zh
Inventor
刘鑫
周怀得
李广泽
徐东
陈佳豫
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Changchun Institute of Optics Fine Mechanics and Physics of CAS
Original Assignee
Changchun Institute of Optics Fine Mechanics and Physics of CAS
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Changchun Institute of Optics Fine Mechanics and Physics of CAS filed Critical Changchun Institute of Optics Fine Mechanics and Physics of CAS
Priority to CN201810799287.7A priority Critical patent/CN109039222B/zh
Publication of CN109039222A publication Critical patent/CN109039222A/zh
Application granted granted Critical
Publication of CN109039222B publication Critical patent/CN109039222B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
    • H02P29/10—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors for preventing overspeed or under speed
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
    • H02P29/20—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors for controlling one motor used for different sequential operations
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
    • H02P2205/07—Speed loop, i.e. comparison of the motor speed with a speed reference

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了一种加速力矩受限的转台运动曲线在线规划方法及系统，方法包括：在速度回路闭环条件下输入对应于不同加速度的等效正弦函数驱动框架转动，采集转台框架的位置信息，得到转台框架的转动惯量；根据最大加速力矩限制值和实测出的框架转动惯量计算出框架运动的最大角加速度值，结合转台观测任务所要求的运动时间，获取框架运动曲线的分段运动时间参数；进一步划分运动曲线全过程，生成对应曲线的实时速度信息和位置信息；将速度及位置信息进行相应量纲转化，采用复合控制方式控制框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。本发明在满足加速力矩限制要求同时，改善系统动态性能，提高系统跟踪精度。

Description

一种加速力矩受限的转台运动曲线在线规划方法及系统
技术领域
本发明属于星载转台伺服控制技术领域，特别涉及一种加速力矩受限的转台运动曲线在线规划方法及系统。
背景技术
随着卫星平台技术的发展和观测目标的多样化，一维及二维载荷转台的应用越来越广泛，特别是带有稳定成像的二维框架转台。二维框架转台其优势在于，既可以根据指令完成指定位置的定点观测，又可以进行区域范围的摆扫侦测，对侦测到的可疑目标还可以做进一步跟踪，实时获取目标地理位置。在载荷工作过程中，转台的加速力矩受限，如果力矩超过限制值，则会影响到星载平台姿态控制精度，导致载荷的工作精度降低，严重情况下可导致本次工作失败。因此为保证各载荷的工作精度，必须严格控制载荷的加速力矩，满足力矩约束条件，以保证其工作精度指标。
星载转台的加速力矩取决于转台活动部件的转动惯量和转台的角加速度，转动惯量为一常数，转台加速力矩的大小就取决于角加速度值。在转台受限的加速力矩已知的情况下，转台工作的最大加速度就可以计算出来。转台在观测任务中会对运动时间提出明确要求，以指定位置扫描为例，要求在一定时间内在指定坐标位置达到设定的速度后开始扫描，在此过程中转台的最大加速度不能超过加速力矩所限制的最大值。传统伺服控制系统所采用的位置回路和速度回路双闭环的控制结构，由于阶跃响应超调过程的存在，很难同时满足转台运动时间性及加速力矩受限的要求。
发明内容
本发明旨在克服现有技术的缺陷，提供一种加速力矩受限的转台运动曲线在线规划方法及系统。
为实现上述目的，本发明采用以下技术方案：提供一种加速力矩受限的转台运动曲线在线规划方法，其特征在于，包括如下步骤：
步骤一、在速度回路闭环条件下输入对应于不同加速度的等效正弦函数驱动框架转动，采集框架的位置信息，由电机的机械运动方程得到转台框架的转动惯量；
步骤二、根据最大加速力矩限制值和步骤一实测出的框架转动惯量计算出框架运动的最大角加速度，结合转台观测任务所要求的运动时间，获取运动框架曲线的分段运动时间参数，包括变加速时间参数、匀加速时间参数；
步骤三、以步骤二获取的分段运动时间参数进一步划分运动曲线全过程，生成对应曲线的实时速度信息和位置信息；
步骤四、将步骤三的速度及位置信息进行相应量纲转化，采用复合控制方式控制框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
所述步骤一中，在速度回路闭环条件下输入对应于不同加速度的等效正弦函数方程为：
Figure BDA0001736724550000021
公式(1a)中A为正弦函数的幅值，ωr为正弦函数的角频率，vmax为等效正弦函数的最大速度值，amax为等效正弦函数的最大加速度值。
电机的机械运动方程如下：
Figure BDA0001736724550000031
公式(2a)中Jm为框架的转动惯量，TL为框架的负载转矩，Jm和TL均为未知参数；TM为电机输出转矩，可由公式TM＝KT·iM计算得到；KT为电机转矩系数；iM为电机电流，可实测电机电流得到，B为阻尼系数，与框架所选择的材料有关，由相关机械设计人员给出相应的具体值；ωm为电机转动角速度，由转台所安装的位置测量部件的位置信息微分得到，或由测速部件直接给出；
Figure BDA0001736724550000032
为电机转动角加速度，可通过角速度ωm微分得到。
根据公式(1a)设计二组对应的等效正弦函数作为输入，分别记录对应的转台框架的位置信息，再经由公式(2a)解方程组即可得到框架的转动惯量Jm、框架的负载转矩TL。
所述步骤二中，根据最大加速力矩限制值和步骤一实测出的框架转动惯量计算得到框架运动的最大角加速度，公式如下:
Figure BDA0001736724550000033
公式(3a)中，加速力矩TB，框架转动惯量Jm，均为已知项，通过计算可知相应的框架最大角加速度aω值。
星载转台具有多种运动模式，例如定点预置，匀速摆扫及指定位置调转等。相比其他两种模式，指定位置调转模式运动需要的加速力矩最大。转台在指定位置调转过程：在指定位置S0处以速度V0结束成像扫描工作，调转，在Td时间后，再在指定位置S0以速度-V0往回摆扫，开启下一次成像扫描工作。在此过程中，转台运动带来的加速力矩不允许超过限定值。为了更准确地阐述本发明提出的运动曲线在线规划方法，以框架在指定位置调转为例来进行分析。
针对指定位置调转过程，Td为调转过程的时间(一般为固定时间)，t1为变加速时间，t2为匀加速时间，t3为变减速时间，t1和t3时间设为相同，aω为曲线最大加速度值，从起始速度V0到速度为0，再从速度为0减速到-V0，这两个过程占用的调转时间一致。以速度VO到速度为0为对象，加速度变化方程如式(4a)所示，速度变化方程如式(5a)所示。
Figure BDA0001736724550000041
Figure BDA0001736724550000042
设定t1＝t3，当t＝Td/2时，V3＝0。即
V3＝V0-kt1(t2+t3)＝V0-kt1(Td/2-t1)＝0 (6a)
再根据已知的最大加速度值|aω|＝kt1，可得t1及变加速度系数k。
所述步骤三中，以步骤二获得的分段运动时间参数t1，及已知的调转时间Td就可以得知运动曲线全过程，生成对应曲线的速度信息V(t)和位置信息S(t)。V0是指定的初始速度，S0是指定的调转位置，该指定参数既可以提前装订进所述步骤二中，也可以根据任务需要通过指令获得，在线规划对应不同的初始速度和不同调转位置的运动曲线速度信息和位置信息。
运动曲线的速度方程：
Figure BDA0001736724550000051
运动曲线的位置方程：
Figure BDA0001736724550000052
所述步骤四中，将步骤三计算获取的位置及速度信息进行相应量纲转化，采用复合控制原理驱动框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
为实现上述目的，本发明还采用以下技术方案：一种加速力矩受限的转台运动曲线在线规划系统，包括以下单元：
转动惯量获取单元：用于在速度回路闭环条件下输入对应于不同加速度的等效正弦函数驱动框架转动，采集框架的位置信息，由电机的机械运动方程获取框架的转动惯量；
分段运动时间参数获取单元：用于根据最大加速力矩限制值和转动惯量获取单元实测出的框架转动惯量计算获取框架运动的最大角加速度，结合转台观测任务所要求的运动时间，获取框架运动曲线的分段运动时间参数，包括变加速时间参数、匀加速时间参数；
速度信息和位置信息生成单元：用于通过分段运动时间参数获取单元获取的分段运动时间参数进一步划分运动曲线全过程，生成对应曲线的实时速度信息和位置信息；
框架运动控制单元：用于将速度信息和位置信息生成单元生成的速度及位置信息进行相应量纲转化，采用复合控制方式控制框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
所述转动惯量获取单元中，在速度回路闭环条件下输入对应于不同加速度的等效正弦函数方程为：
Figure BDA0001736724550000061
公式(1b)中A为正弦函数的幅值，ωr为正弦函数的角频率，vmax为等效正弦函数的最大速度值，amax为等效正弦函数的最大加速度值。
电机的机械运动方程如下
Figure BDA0001736724550000062
公式(2b)中Jm为框架的转动惯量，TL为框架的负载转矩，Jm和TL均为未知参数；TM为电机输出转矩，可由公式TM＝KT·iM计算得到；KT为电机转矩系数；iM为电机电流，可实测电机电流得到，B为阻尼系数，与框架所选择的材料有关，由相关机械设计人员给出相应的具体值；ωm为电机转动角速度，由转台所安装的位置测量部件的位置信息微分得到，或由测速部件直接给出；
Figure BDA0001736724550000063
为电机转动角加速度，可通过角速度ωm微分得到。
根据公式(1b)设计二组对应的等效正弦函数作为输入，分别记录对应的转台框架的位置信息，再经由公式(2b)解方程组即可得到框架的转动惯量Jm、框架的负载转矩TL。
所述分段运动时间参数获取单元中，根据提供的最大加速力矩限制值和转动惯量获取单元获取的框架转动惯量计算得到框架运动的最大角加速度，公式如下:
Figure BDA0001736724550000071
公式(3b)中，加速力矩TB，框架转动惯量Jm，均为已知项，通过计算可知相应的框架最大角加速度值aω。
以框架在指定位置调转为例来进行分析，Td为调转过程的时间，t1为变加速时间，t2为匀加速时间，t3为变减速时间，t1和t3时间设为相同，aω为曲线最大加速度值，从起始速度V0到速度为0，再从速度为0减速到-V0，这两个过程占用的调转时间一致。以速度VO到速度为0为对象，加速度变化方程如式(4b)所示，速度变化方程如公式(5b)所示。
Figure BDA0001736724550000072
Figure BDA0001736724550000073
设定t1＝t3，当t＝Td/2时，V3＝0。即：
V3＝V0-kt1(t2+t3)＝V0-kt1(Td/2-t1)＝0 (6b)
再根据已知的最大加速度值|aω|＝kt1，可得t1，及变加速度系数k。
所述速度信息和位置信息生成单元中，以分段运动时间参数获取单元获取的分段运动时间参数t1，及已知的调转时间Td就可以得知运动曲线全过程，生成对应曲线的速度信息V(t)和位置信息S(t)，V0是指定的初始速度，S0是指定的调转位置。
运动曲线的速度方程：
Figure BDA0001736724550000081
运动曲线的位置方程：
Figure BDA0001736724550000082
所述框架运动控制单元中，将速度信息和位置信息生成单元计算得到的位置及速度信息进行相应量纲转化，采用复合控制原理驱动框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
本发明提出的转台运动曲线规划系统，速度信息和位置信息生成单元可以将分段运动时间参数获取单元的时间参数作为已知常数，将指定的初始速度V0和调转位置S0作为形参，将公式(7b)和公式(8b)封装成独立函数，在线规划对应不同的初始速度和不同调转位置的运动曲线速度信息和位置信息。
本发明针对星载转台加速力矩受限，即转台工作最大角加速度受到限制情况下，提出了一种加速力矩受限的转台运动曲线在线规划方法及系统。该方法及系统根据转台观测任务要求的运动时间和转台工作所限制的最大加速力矩等指标，在线计算出运动曲线分段时间参数，再通过公式获得所规划曲线的速度信息和位置信息，速度信息作为前馈，形成复合控制方式控制框架运动。与常规的位置、速度双闭环控制方式相比，基于运动曲线位置信息和速度信息形成的复合控制系统，其跟踪精度更高，超调量更小，过渡时间更短，因跟踪误差而带来的加速力矩也随之更小，可很好满足加速力矩受限要求。
附图说明
图1为本发明的运动曲线在线规划方法流程图
图2为指定位置调转过程运动曲线速度曲线示意图。
图3为基于运动曲线信息的复合控制原理图。
图4为具体实施例规划的运动曲线信息。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及具体实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，而不构成对本发明的限制。
结合图1说明具体实施方式，本发明的方法具体实施方式步骤如下：
1)控制系统在速度回路闭环条件下输入对应于不同加速度的等效正弦函数驱动框架转动，采集转台框架的位置信息，由电机的机械运动方程得到转台框架的转动惯量，步骤如下：
设计两组对应于不同加速度的等效正弦函数，作为速度回路闭环的输入控制框架转动；
y1＝A1sin(ωr1·t)y2＝A2sin(ωr2·t) (9a)
采集转台对应框架的位置信息，将位置信息微分得到框架的实际最大速度值，再将该速度值微分得到框架的实际最大加速度值，根据位置信息的精度可采取相应的平滑滤波；
采集电机相电流，由已知的电机转矩系数，计算得到电机转矩TM。根据电机的机械运动方程，由式(9a)得的参数组成二元一次方程：
Figure BDA0001736724550000101
解方程组获得框架转动惯量Jm，负载转矩TL。
2)根据最大加速力矩限制值和步骤一实测出的框架转动惯量计算得到框架运动的最大角加速度，结合转台观测任务所要求的运动时间，得到运动曲线的分段运动时间参数；
根据已知加速力矩限制值TB，和已知的转动惯量Jm，计算得到最大加速度值
aω＝TB/Jm (11a)
针对指定位置调转过程运动时间Td，以及式(11a)所得的最大加速度值aω，由式(6a)变换可得
Figure BDA0001736724550000102
同时t3＝t1，
Figure BDA0001736724550000103
3)以步骤二获得的分段运动时间参数进一步划分运动曲线全过程，生成对应曲线的速度信息和位置信息；
以步骤二获得的分段运动时间参数t1、t2、t3以及k，结合图3可知运动曲线分段全过程，按照变加速度及速度计算公式(式(4a)和式(5a))，得到运动曲线的速度信息V(t)，见式(7a)；速度信息积分得到位置信息S(t)，见式(8a)。需要说明的是，式(7a)和式(8a)中数据与速度及位置回路采样频率相对应例如调转时间0.5s，速度回路采样频率1000Hz，那么速度信息和位置信息都分别包含500个点。
4)伺服控制系统将步骤三的位置及速度信息进行相应量纲转化，采用复合控制原理控制框架的运动，即位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
在位置回路和速度回路完成闭环的基础上，根据复合控制原理应用位置曲线的位置信息和速度信息。速度信息作为前馈支路引入到速度回路，需要进行量纲的转化，要将速度信息转化为位置反馈元件如编码器的码值。速度信息纲转化的意义在于将速度信息与位置测量元件的码值进行统一，提高运算精度。
基于上述方法，本发明提供一种加速力矩受限的转台运动曲线在线规划系统，方案具体实施方式如下：
a)转动惯量获取单元
设计两组对应于不同加速度的等效正弦函数，作为速度回路闭环的输入控制框架转动；
y1＝A1sin(ωr1·t)y2＝A2sin(ωr2·t) (9b)
采集转台对应框架的位置信息，将位置信息微分得到框架的实际最大速度值，再将该速度值微分得到框架的实际最大加速度值，根据位置信息的精度可采取相应的平滑滤波；
采集电机相电流，由已知的电机转矩系数，计算得到电机转矩TM。根据电机的机械运动方程，由式(9b)得的参数组成二元一次方程：
Figure BDA0001736724550000121
解方程组获得转台框架的转动惯量Jm，框架的负载转矩TL。
b)分段运动时间参数获取单元
根据已知加速力矩限制值TB，和已知的转动惯量Jm，计算得到最大加速度值
aω＝TB/Jm (11b)
针对指定位置调转过程运动时间Td，以及式(11b)所得的最大加速度值aω，由式(6b)变换可得
Figure BDA0001736724550000122
由t3＝t1得
Figure BDA0001736724550000123
综上，分段运动时间参数全部可知。
c)速度信息和位置信息生成单元
通过分段运动时间参数获取单元获取的分段运动时间参数进一步划分运动曲线全过程，生成对应曲线的实时速度信息和位置信息；
根据分段运动时间参数获取单元的分段运动时间参数t1、t2、t3以及k，结合图3的运动曲线分段全过程，按照变加速度及速度计算公式(式(4b)和式(5b))，得到运动曲线的速度信息V(t)，见式(7b)；速度信息积分得到位置信息S(t)，见式(8b)。
d)框架运动控制单元
在位置回路和速度回路完成闭环的基础上，根据复合控制原理应用位置曲线的位置信息和速度信息。速度信息作为前馈支路引入到速度回路，需要进行量纲的转化，要将速度信息转化为位置反馈元件如编码器的码值。
本发明提供一个方法的具体实施例：
结合图1-图4说明所述实施例，所述实施例为对以上方法实施方式的进一步说明，以指二维转台方位框架在定位置调转过程为例，具体过程为：
以速度10°/s、加速度30°/s2的等效正弦函数y1＝3.33°sin(3t)作为方位框架速度回路的闭环输入，采集位置测量元件(编码器)实测得到最大速度10°/s(0.175rad/s)，最大加速度29.5°/s2(0.515rad/s2)，电机转矩系数KT＝0.177N·m/A，框架运动过程中监测记录最大电流为0.6A。
以速度50°/s、加速度80°/s2的等效正弦函数y2＝31.25°sin(1.6t)作为方位框架速度回路的闭环输入，采集位置测量元件(例如编码器)实测得到最大速度49.8°/s(0.869rad/s)，最大加速度79°/s2(1.379rad/s2)，框架运动过程中监测记录最大电流为1.4A。
阻尼系数B＝0.12，根据式(10a)，得到方程组：
Figure BDA0001736724550000131
经计算可知Jm＝0.0675kg·m2，TL＝0.05N·m。
星载平台卫星姿态控制系统的最大加速力矩限制值TB＝0.16N·m，计算得到最大加速度值：
Figure BDA0001736724550000132
考虑到跟踪误差产生的影响，最大加速值取120°/s2。
设框架在指定位置调转过程中具体要求:框架在指定位置S0＝10°处，以速度V0＝15°/s结束成像扫描工作，开始调转，在Td＝0.3s时间后，再在指定位置S0＝10°以速度-V0＝-15°/s往回摆扫，开启下一次成像扫描工作。据此，计算运动曲线分段运动时间参数：
Figure BDA0001736724550000141
则t3＝t1＝0.025s，t2＝0.1s。
由上述运动参数划分运动曲线全过程，生成对应曲线的速度信息和位置信息。
运动曲线的速度方程：
Figure BDA0001736724550000142
运动曲线的位置方程：
Figure BDA0001736724550000143
运动曲线的具体信息如图4所示。
如图2所示，根据复合控制原理，位置信息作为位置回路的输入，速度信息作为前馈支路引入到速度回路，需要进行量纲的转化，以24位编码器，采样频率1000Hz的来说，速度回路的一个码值代表77.247″/s，则1°/s速度对应的码值为46.6，即量纲为46.6/s。
以上所述本发明的具体实施方式，并不构成对本发明保护范围的限定。任何根据本发明的技术构思所作出的各种其他相应的改变与变形，均应包含在本发明权利要求的保护范围内。

Claims (10)

1.一种加速力矩受限的转台运动曲线在线规划方法，其特征在于，包括，如下步骤：
步骤一、在速度回路闭环条件下输入对应于不同加速度的等效正弦函数驱动框架转动，采集转台框架的位置信息，由电机的机械运动方程得到转台框架的转动惯量；
步骤二、根据最大加速力矩限制值和步骤一实测出的框架转动惯量计算出框架运动的最大角加速度，结合转台观测任务所要求的运动时间，获取框架运动曲线的分段运动时间参数；
步骤三、以步骤二获取的分段运动时间参数进一步划分运动曲线全过程，生成对应曲线的实时速度信息和位置信息；
步骤四、将步骤三的速度及位置信息进行相应量纲转化，采用复合控制方式控制框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
2.如权利要求1所述的方法，其特征在于，所述步骤一中，在速度回路闭环条件下输入对应于不同加速度的等效正弦函数方程为：
Figure FDA0002432667680000011
公式(1a)中A为正弦函数的幅值，ωr为正弦函数的角频率，vmax为等效正弦函数的最大速度值，amax为等效正弦函数的最大加速度值；
电机的机械运动方程如下：
Figure FDA0002432667680000012
公式(2a)中Jm为框架的转动惯量，TL为框架的负载转矩，Jm和TL均为未知参数；TM为电机输出转矩，可由公式TM＝KT·iM计算得到；KT为电机转矩系数；iM为电机电流，B为阻尼系数，ωm为电机转动角速度，
Figure FDA0002432667680000021
为电机转动角加速度；
根据公式(1a)设计二组对应的等效正弦函数作为输入，分别记录对应的转台框架的位置信息，再经由公式(2a)解方程组即可得到框架的转动惯量Jm、框架的负载转矩TL。
3.如权利要求1所述的方法，其特征在于，所述步骤二中，根据最大加速力矩限制值和步骤一实测出的框架转动惯量计算得到框架运动的最大角加速度，公式如下:
Figure FDA0002432667680000022
公式(3a)中，加速力矩TB，ωm为电机转动角速度，框架转动惯量Jm，均为已知项，通过计算可知对应的框架最大角加速度值aω。
4.如权利要求1所述的方法，其特征在于，所述步骤三中，以步骤二获得的分段运动时间参数，及已知的调转时间就可以得知运动曲线全过程，生成对应曲线的速度信息和位置信息。
5.如权利要求1所述的方法，其特征在于，所述步骤四中，将步骤三计算获取的位置及速度信息进行相应量纲转化，采用复合控制原理驱动框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
6.一种加速力矩受限的转台运动曲线在线规划系统，其特征在于，包括：
转动惯量获取单元：用于在速度回路闭环条件下输入对应于不同加速度的等效正弦函数驱动框架转动，采集框架的位置信息，由电机的机械运动方程获取框架的转动惯量；
分段运动时间参数获取单元：用于根据最大加速力矩限制值和转动惯量获取单元实测出的框架转动惯量计算获取框架运动的最大角加速度，结合转台观测任务所要求的运动时间，获取框架运动曲线的分段运动时间参数；
速度信息和位置信息生成单元：用于通过分段运动时间参数获取单元得到的分段运动时间参数进一步划分运动曲线全过程，生成对应曲线的实时速度信息和位置信息；
框架运动控制单元，用于将速度信息和位置信息生成单元生成的速度及位置信息进行相应量纲转化，采用复合控制方式控制框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
7.如权利要求6所述的系统，其特征在于，所述转动惯量获取单元中，在速度回路闭环条件下输入对应于不同加速度的等效正弦函数方程为：
Figure FDA0002432667680000031
公式(1b)中A为正弦函数的幅值，ωr为正弦函数的角频率，vmax为等效正弦函数的最大速度值，amax为等效正弦函数的最大加速度值；
电机的机械运动方程如下：
Figure FDA0002432667680000032
公式(2b)中Jm为框架的转动惯量，TL为框架的负载转矩，Jm和TL均为未知参数；TM为电机输出转矩，可由公式TM＝KT·iM计算得到；KT为电机转矩系数；iM为电机电流，B为阻尼系数，ωm为电机转动角速度，
Figure FDA0002432667680000033
为电机转动角加速度；
根据公式(1b)设计二组对应的等效正弦函数作为输入，分别记录对应的转台框架的位置信息，再经由公式(2b)解方程组即可得到框架的转动惯量Jm、框架的负载转矩TL。
8.如权利要求6所述的系统，其特征在于，所述分段运动时间参数获取单元中，根据提供的最大加速力矩限制值和转动惯量获取单元获取的框架转动惯量计算得到框架运动的最大角加速度，公式如下:
Figure FDA0002432667680000041
公式(3b)中，加速力矩TB，ωm为电机转动角速度，框架转动惯量Jm，均为已知项，通过计算可知相应的框架最大角加速度值aω。
9.如权利要求6所述的系统，其特征在于，所述速度信息和位置信息生成单元中，以分段运动时间参数获取单元获取的分段运动时间参数，及已知的调转时间就可以得知运动曲线全过程，生成对应曲线的速度信息和位置信息。
10.如权利要求6所述的系统，其特征在于，所述框架运动控制单元中，将速度信息和位置信息生成单元计算得到的位置及速度信息进行相应量纲转化，采用复合控制原理驱动框架的运动，将位置信息作为位置回路的输入，速度信息以前馈的方式加入到速度回路。
CN201810799287.7A 2018-07-19 2018-07-19 一种加速力矩受限的转台运动曲线在线规划方法及系统 Expired - Fee Related CN109039222B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810799287.7A CN109039222B (zh) 2018-07-19 2018-07-19 一种加速力矩受限的转台运动曲线在线规划方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810799287.7A CN109039222B (zh) 2018-07-19 2018-07-19 一种加速力矩受限的转台运动曲线在线规划方法及系统

Publications (2)

Publication Number Publication Date
CN109039222A CN109039222A (zh) 2018-12-18
CN109039222B true CN109039222B (zh) 2020-06-12

Family

ID=64644557

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810799287.7A Expired - Fee Related CN109039222B (zh) 2018-07-19 2018-07-19 一种加速力矩受限的转台运动曲线在线规划方法及系统

Country Status (1)

Country Link
CN (1) CN109039222B (zh)

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4673326B2 (ja) * 2007-01-11 2011-04-20 オークマ株式会社 回転軸の位置制御装置
CN100559315C (zh) * 2008-04-22 2009-11-11 北京航空航天大学 一种双框架磁悬浮控制力矩陀螺控制系统
CN105005312B (zh) * 2015-06-29 2017-11-03 哈尔滨工业大学 一种基于最大角加速度和最大角速度卫星规划轨迹方法
JP6433387B2 (ja) * 2015-07-13 2018-12-05 三菱電機株式会社 交流回転機の制御装置及び交流回転機の慣性モーメント演算方法
CN106571759B (zh) * 2015-10-12 2019-02-22 上海安浦鸣志自动化设备有限公司 一种显著提升定位系统响应的前馈方法
CN106737656A (zh) * 2015-11-20 2017-05-31 沈阳新松机器人自动化股份有限公司 一种机器人负载惯量识别方法
CN107199569B (zh) * 2017-06-22 2020-01-21 华中科技大学 一种基于关节能量均衡分配的关节机器人轨迹规划方法

Also Published As

Publication number Publication date
CN109039222A (zh) 2018-12-18

Similar Documents

Publication Publication Date Title
CN107993257B (zh) 一种智能imm卡尔曼滤波前馈补偿目标追踪方法及系统
Lin et al. Modeling and improvement of dynamic contour errors for five-axis machine tools under synchronous measuring paths
CN110531707A (zh) Scara机器人的摩擦模型改进以及动力学参数辨识方法
CN101405564A (zh) 测量工件的装置和方法
CN109782815B (zh) 基于多轴联动系统的复杂型面自适应测量路径规划方法
JP2014136260A (ja) 制御装置
CN105867113A (zh) 一种伺服控制器、伺服控制系统及伺服控制方法
CN109656196A (zh) 数控系统综合性能测试方法与装置
US4206393A (en) Numerical control systems for machine tools
CN109039222B (zh) 一种加速力矩受限的转台运动曲线在线规划方法及系统
Kirchhoff et al. Velocity estimation for ultralightweight tendon-driven series elastic robots
CN103591967A (zh) 用于光学伺服系统频谱曲线测试的光学Chirp信号生成方法
CN105700470B (zh) 一种用于减小机床伺服进给系统跟踪误差的方法
CN109015646A (zh) 位置信息自标定方法、装置、设备和存储介质
CN108563246B (zh) 显微镜下的旋转定位平台的控制系统和控制方法
CN108723888A (zh) 直线进给轴刀尖点相对于光栅检测点位置偏差估计方法
Janiszewski et al. Kalman filter sensor fusion for multi-head position encoder
CN107742997B (zh) 双轴转位机构控制系统、控制方法及捷联惯组自标定方法
JP2017188033A (ja) 送り軸制御装置における周波数特性測定方法
Zolotukhin et al. A relative measurement based leader-follower formation control of mobile robots
CN112003503A (zh) 一种基于蚁群龙贝格观测器的永磁同步直线电机控制方法
CN107167135B (zh) 一种扫描镜指向高精度静态测角方法
CN106970529A (zh) 一种电机高速高精度转动规划定位控制方法
CN113189956B (zh) 两轴两框架光电稳像平台的伺服系统在线调试方法
CN117331342B (zh) 一种基于ffrls算法的机床进给轴参数辨识方法

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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20200612

CF01 Termination of patent right due to non-payment of annual fee