CN108279696B - 一种平面运动倒立摆及其控制系统和控制方法 - Google Patents
一种平面运动倒立摆及其控制系统和控制方法 Download PDFInfo
- Publication number
- CN108279696B CN108279696B CN201810239295.6A CN201810239295A CN108279696B CN 108279696 B CN108279696 B CN 108279696B CN 201810239295 A CN201810239295 A CN 201810239295A CN 108279696 B CN108279696 B CN 108279696B
- Authority
- CN
- China
- Prior art keywords
- linear motor
- guide rail
- swing rod
- trolley
- linear
- 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
- 230000033001 locomotion Effects 0.000 title claims abstract description 66
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000006073 displacement reaction Methods 0.000 claims description 51
- 238000004891 communication Methods 0.000 claims description 7
- 238000012545 processing Methods 0.000 claims description 7
- 238000012544 monitoring process Methods 0.000 claims description 6
- 230000001360 synchronised effect Effects 0.000 claims description 2
- 238000011160 research Methods 0.000 abstract description 3
- 230000005540 biological transmission Effects 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000026058 directional locomotion Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000002194 synthesizing effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Toys (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种平面运动倒立摆，由方型支架、平面运动单元和摆杆部分组成。所述平面运动单元包括第一直线电机、底座、第二直线电机以及一个法兰；所述第一直线电机、第二直线电机空间上十字交叉叠放，第一直线电机提供X轴方向运动，第二直线电机提供Y轴方向运动，合成运动可以沿着平面任意方向运动。所述摆杆部分上端安有高精度姿态传感器，可实时读取摆杆与竖直方向角度和摆杆倾倒数据并传递给DSP控制器，所述DSP控制器进一步根据所述摆杆状态数据进行处理，获得控制量输出数据给电机驱动器。所述平面运动倒立摆系统采用直线电机直接驱动摆杆部分，省去中间传动机构干扰，使得控制更加精确，在军工、航天以及科研教学有着广泛地用途。
Description
技术领域
本发明属于自动控制技术的科研与教学实验装置领域，具体来说涉及一种平面运动倒立摆及其控制系统和控制方法。
背景技术
由于倒立摆系统是一个典型的快速、多变量、非线性、强耦合、自然不稳定系统，而且在它的控制过程中，能有效反映诸如镇定性、鲁棒性、随动性以及跟踪等许多关键问题，因此是进行控制理论教学及开展各种控制策略的理想实验平台，人们常常利用倒立摆检验各种控制算法的不稳定性、非线性和快速系统的控制能力以及各种控制算法的有效性。对倒立摆系统进行研究，不仅具有理论意义，其类似的控制方法在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行器中的姿态控制和一般工业应用等方面都具有广阔的利用开发前景。传统的倒立摆通常为直线倒立摆系统、环形倒立摆系统，它们都是通过在线性轨迹上运动而达到平衡，不能在平面内完成任意方向的运动。
发明内容
本发明针对传统倒立摆的不足，提出了一种平面运动倒立摆，由方型支架、平面运动单元和摆杆部分组成，可以实时读取摆杆与竖直方向角度和角加速度数据并传送给控制板，而且采用直线电机直接驱动小车，省去了中间的传动机构及干扰，使得控制更加精确可靠。
本发明是通过以下技术方案实现的：
一种平面运动倒立摆，包括方型支架1、平面运动单元2、摆杆部分3；所述平面运动单元2放置在方型支架1的上方，摆杆部分3通过连接件和平面运动单元2固定；
所述平面运动单元2包括第一直线电机20、底座21、第二直线电机20’以及一个法兰5；所述第一直线电机20包括相互配合的第一小车202和第一导轨203，所述第一导轨203固定安装在所述底座21上；所述第二直线电机20’包括相互配合的第二小车202’和第二导轨203’，所述第二导轨203’固定安装在所述方型支架1上；
所述第一直线电机20和所述第二直线电机20’空间上十字交叉叠放，所述底座21固定安装在所述第二小车202’的顶部；所述法兰5固定安装在第一小车202的顶部，所述摆杆部分3与所述法兰5连接；
所述第一直线电机20提供X轴方向运动，所述第二直线电机20’提供Y轴方向运动，所述第一直线电机20和所述第二直线电机20’的合成运动提供水平面内任意方向的直线运动；
所述第一小车202上设有第一线性编码器205，所述第一导轨203上设有与所述第一线性编码器205相对应的第一磁栅206；所述第二小车202’上设有第二线性编码器205’，所述第二导轨203’上设有与所述第二线性编码器205’相对应的第二磁栅206’；
所述摆杆部分3内设有姿态传感器；
所述第一直线电机20和所述第二直线电机20’结构相同；
所述第一导轨203的截面呈U形槽状，且所述第一导轨203的槽口位于竖直方向上的一侧面；所述第一小车202呈倒U形块状，所述第一小车202跨设在所述第一导轨203上；所述第一直线电机20进一步包括第一直线电机定子200以及第一直线电机动子201；所述第一直线电机定子200均匀分布在第一导轨203的槽口内上下两侧的水平内壁上；第一直线电机动子201一端固定于所述第一小车202的一侧直立内壁上；第一直线电机动子201的另一端配合位于第一导轨203的槽口内，且与第一直线电机定子200相对应；所述第一线性编码器205设置在所述第一小车202远离所述第一导轨203槽口的一侧直立内壁上，所述第一磁栅206设置在所述第一导轨203远离槽口的直立外壁上；
所述第二导轨203’的截面呈U形槽状，且所述第二导轨203’的槽口位于竖直方向上的一侧面；所述第二小车202’呈倒U形块状，所述第二小车202’跨设在所述第二导轨203’上；所述第二直线电机20’进一步包括第二直线电机定子200’以及第二直线电机动子201’；所述第二直线电机定子200’均匀分布在第二导轨203’的槽口内上下两侧的水平内壁上；第二直线电机动子201’一端固定于所述第二小车202’的一侧直立内壁上；第二直线电机动子201’的另一端配合位于第二导轨203’的槽口内，且与第二直线电机定子200’相对应；
所述第二线性编码器205’设置在所述第二小车202’远离所述第二导轨203’槽口的一侧直立内壁上，所述第二磁栅206’设置在所述第二导轨203’远离槽口的直立外壁上；所述第一导轨203的顶部设置有小导轨204，小导轨长度方向的两侧设置有浅槽，与小导轨对应的小车的内侧顶部设置有槽钢状的固定板2020，所述固定板2020的槽口内两侧面上设置有凸条和小导轨上浅槽向配合，保证小车沿导轨直线移动；
所述第二导轨203’的顶部设置有第二导轨204’，小导轨长度方向的两侧设置有浅槽，与小导轨对应的小车的内侧顶部设置有槽钢状的固定板2020’，所述固定板2020’的槽口内两侧面上设置有凸条和小导轨上浅槽向配合，保证小车沿导轨直线移动。
所述方型支架1由一对工型导轨11、一对L型支撑座10以及一对U型底座12组成，所述工型导轨11、L型支撑座10以及U型底座12都是呈平行放置，所述工型导轨11与L 型支撑座10垂直放置，U型底座12和工型导轨11相配合。
所述摆杆部分3包括摆杆31、球铰链座30、姿态传感器支架32，所述摆杆31底端设置有球体，可嵌入球铰链座30并且旋转运动；所述姿态传感器支架32用于安装姿态传感器，球铰链支架30通过法兰5与上方直线电机20底座相连接。
所述第一直线电机20和第二直线电机20’均为无铁心永磁同步直线电机。
所述L型支撑座10和底座21上均设置有防撞块4，防撞块4的材料为橡胶。
所述倒立摆装置的控制系统，包括：依次通信连接的监测计算机、DSP控制器、电机驱动器；所述DSP控制器分别与所述第一线性编码器205、所述第二线性编码器205’和所述姿态传感器通信连接，所述电机驱动器分别与所述第一直线电机20、第二直线电机 20’连接；其中：
所述第一线性编码器205用于：实时采集所述第一直线电机20中第一小车202的位移信号，即第一位移信号；
所述第二线性编码器205’用于：实时采集所述第二直线电机20’中第二小车202’的位移信号，即第二位移信号；
所述姿态传感器用于：实时采集所述摆杆部分3的摆杆姿态信号；所述摆杆姿态信号具体包括：摆杆角度信号、倾倒方向信号；
所述DSP控制器用于：实时接收所述第一位移信号、第二位移信号、摆杆姿态信号，并进行计算和处理，获得控制量输出数据，并输出相应的信号给伺服驱动器；
所述伺服驱动器用于：实时接收相应的两路信号分别驱动控制第一直线电机20、第二直线电机20’运动，进而控制摆杆31的运动状态；
所述监测计算机用于接收来自DSP控制器的数据，包括摆杆的倾角、倾倒方位、第一直线电机速度、第二直线电机速度。
所述DSP控制器的主控芯片型号为TMS320F28335；所述姿态传感器包括三轴陀螺仪和三轴磁力计，其中，所述陀螺仪用于测量摆杆与竖直方向的夹角，所述磁力计用于测量摆杆倾倒的方向。
所述控制系统实现倒立摆装置运动控制的方法，包括如下步骤：
步骤1，利用所述第一线性编码器205实时采集所述第一直线电机20中第一小车202 的位移信号，即第一位移信号；利用所述第二线性编码器205’实时采集所述第二直线电机20’中第二小车202’的位移信号，即第二位移信号；
步骤2，利用所述姿态传感器实时采集所述摆杆部分3的摆杆姿态信号；所述摆杆姿态信号具体包括：摆杆角度信号、倾倒方向信号；
步骤3，利用所述DSP控制器实时接收所述第一位移信号、第二位移信号、摆杆姿态信号，并进行计算和处理，获得控制量输出数据，并输出相应的信号给电机驱动器；
步骤4，利用所述电机驱动器实时接收相应的两路信号分别驱动控制X轴方向第一直线电机20、Y轴方向第二直线电机20’运动，进而控制摆杆31的运动状态。
在步骤S3中，所述DSP控制器的计算和处理过程具体包括：所述DSP控制器根据所述第一位移信号、第二位移信号、摆杆姿态信号计算获得摆杆状态数据，所述摆杆状态数据包括：摆杆与竖直方向的角度、倾倒的角速度、X轴方向位移和速度、Y轴方向位移和速度、倾倒的方向与X轴方向夹角；所述DSP控制器进一步根据所述摆杆状态数据进行处理，获得控制量输出数据给电机驱动器。
相对于现有技术，本发明的有益效果在于：
现有的实验平台验证的控制算法并不能直接应用于摆杆轨迹是平面的情况下，为解决这个问题，本专利提出了一种平面运动倒立摆。本专利的特点是利用两个直线电机同时作用给摆杆X轴方向运动和Y轴方向运动，再根据平行四边形法则合成运动可以使倒立摆沿着平面做任意方向的运动。而且直线电机具有高速度、高精度、高加速度的优点，结构简单合理，控制效果好。
附图说明
图1为本发明结构示意图。
图2为本发明直线电机示意图。
图3为本发明直线电机剖视图。
图4为本发明控制系统硬件框图。
图中序号：
方型支架1、L型支撑座10、工型导轨11、U型底座12、平面运动单元2、第一直线电机20、底座21、第一直线电机定子200、第一直线电机动子201、第一小车202、第一导轨203、第一小导轨204、第一线性编码器205、第一磁栅206、固定板2020、第二直线电机20’、第二底座21’、第二直线电机定子200’、第二直线电机动子201’、第二小车202’、第二导轨203’、第二小导轨204’、第二线性编码器205’、第二磁栅206’、支板2021、卡座2022、摆杆部分3、球铰链座30、摆杆31、传感器支架32、防撞块4、法兰5。
具体实施方法
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施方式仅仅用以解释本发明，并不用于限定本发明。
实施例1：
参见图1、图2和图3，一种平面运动倒立摆，包括平面运动单元2、方型支架1、摆杆部分3。所述平面运动单元2放置在方型支架1的上方，摆杆部分3通过连接件和平面运动单元2固定。平面运动单元2包括第一直线电机20、底座21、第二直线电机20’以及一个法兰5，所述第一直线电机20包括相互配合的第一小车202和第一导轨203，所述第一导轨203固定安装在所述底座21上；所述第二直线电机20’包括相互配合的第二小车202’和第二导轨203’，所述第二导轨203’固定安装在所述方型支架1上；
所述第一直线电机20和所述第二直线电机20’空间上十字交叉叠放，所述底座21固定安装在所述第二小车202’的顶部；所述法兰5固定安装在第一小车202的顶部，所述摆杆部分3与所述法兰5连接；
所述第一导轨203的顶部设置有小导轨204，小导轨长度方向的两侧设置有浅槽，与小导轨对应的小车的内侧顶部设置有槽钢状的固定板2020，所述固定板2020的槽口内两侧面上设置有凸条和小导轨上浅槽向配合，保证小车沿导轨直线移动；
所述第二导轨203’的顶部设置有第二导轨204’，小导轨长度方向的两侧设置有浅槽，与小导轨对应的小车的内侧顶部设置有槽钢状的固定板2020’，所述固定板2020’的槽口内两侧面上设置有凸条和小导轨上浅槽向配合，保证小车沿导轨直线移动；
所述摆杆部分3包括摆杆31、球铰链座30、姿态传感器支架32，所述摆杆31底端设置有球体，可嵌入球铰链座30并且旋转运动；
所述第一直线电机20提供X轴方向运动，所述第二直线电机20’提供Y轴方向运动，所述第一直线电机20和所述第二直线电机20’的合成运动提供水平面内任意方向的直线运动，
故而倒立摆可以实现平面内任何角度地倾倒。
实施例2：
参见图4，本实施例提供一种适用于实施例1提供的平面运动倒立摆的控制系统，包括：依次通信连接的监测计算机、DSP控制器、电机驱动器；所述DSP控制器分别与所述第一线性编码器205、所述第二线性编码器205’和所述姿态传感器通信连接，所述电机驱动器分别与所述第一线性编码器205、所述第二线性编码器205’通信连接；
所述姿态传感器包括三轴陀螺仪和三轴磁力计，其中，所述陀螺仪用于测量摆杆与竖直方向的夹角，所述磁力计用于测量摆杆倾倒的方向。监测计算机实现对倒立摆摆动过程中各项数据的实时监控，DSP控制器为数据处理机构，将摆杆角度和方位信号和直线电机位移信号进行处理，电机驱动器用于直线电机驱动。
姿态传感器由三轴陀螺仪、三轴加速度计以及三轴磁力计组成，陀螺仪用于测量摆杆与竖直方向的夹角，加速度计数据本专利不使用，磁力计用于测量摆杆倾倒的方向。线性编码器检测到位移信号，并通过磁栅输出位移信号，DSP控制器接收来自姿态传感器的摆杆角度信号、倾倒方向信号和光栅输出的小车位移信号，通过相应的控制算法计算输出精确的控制量，经过DA转换后输出模拟控制信号，再经电机驱动器放大后输出能驱动直线电机的电流来使其输出相应的控制力来实现平面运动倒立摆倒立摆的平衡。
具体工作原理如下：
步骤1：启动电源同时给控制器和直线电机供电，人为将摆杆竖直摆放，由于重力的作用摆杆会沿着球铰链座沿着任意方向倾倒。
步骤2：姿态传感器开始工作，在每个工作周期内，陀螺仪不断将摆杆与竖直方向的角度信号传递给DSP控制器，磁力计不断将摆杆倾倒的方向信号传递给DSP控制器，线性编码器不断将位移信号传递给DSP控制器，DSP控制器对数据进行二次处理得到所需要的精确数据，即得到摆杆与竖直方向的角度、倾倒的角速度、X轴方向位移和速度、Y 轴方向位移和速度、倾倒的方向与X轴方向夹角。
步骤3：将步骤2的得到的数据代入控制算法得到控制量输出值，DSP控制器产生信号给电机驱动器，X轴方向直线电机提供摆杆X轴方向运动的速度大小和方向，Y轴方向直线电机提供摆杆Y轴方向运动的速度大小和方向，再根据平行四边形法则合成运动驱动摆杆底座沿着摆杆倾倒反方向运动。
步骤4：由于工作周期很短和惯性的作用，摆杆会有保持竖直的趋势，只要优化DSP控制器算法即可达到更加精确的倒立状态。
实施例3：
参见图4，基于实施例2提供的控制系统实现倒立摆运动控制的方法，包括如下步骤：步骤1，利用所述第一线性编码器205实时采集所述第一直线电机20中第一小车202 的位移信号，即第一位移信号；利用所述第二线性编码器205’实时采集所述第二直线电机20’中第二小车202’的位移信号，即第二位移信号；
步骤2，利用所述姿态传感器实时采集所述摆杆部分3的摆杆姿态信号；所述摆杆姿态信号具体包括：摆杆角度信号、倾倒方向信号；
步骤3，利用所述DSP控制器实时接收所述第一位移信号、第二位移信号、摆杆姿态信号，并进行计算和处理，获得控制量输出数据，并输出相应的信号给电机驱动器；
步骤4，利用所述电机驱动器实时接收所述第一位移信号、第二位移信号，并据此控制所述摆杆部分3的工作；
在步骤3中，所述DSP控制器的计算和处理过程具体包括：所述DSP控制器根据所述第一位移信号、第二位移信号、摆杆姿态信号计算获得摆杆状态数据，所述摆杆状态数据包括：摆杆与竖直方向的角度、倾倒的角速度、X轴方向位移和速度、Y轴方向位移和速度、倾倒的方向与X轴方向夹角；所述DSP控制器进一步根据所述摆杆状态数据进行处理，获得控制量输出数据。重复上述步骤最终使得摆杆达到竖直状态。
Claims (5)
1.一种平面运动倒立摆，包括方型支架（1）、平面运动单元（2）、摆杆部分（3）；所述平面运动单元（2）放置在方型支架（1）的上方，摆杆部分（3）通过连接件和平面运动单元（2）固定；其特征在于：
所述平面运动单元（2）包括第一直线电机（20）、底座（21）、第二直线电机（20’）以及一个法兰（5）；
所述第一直线电机（20）包括相互配合的第一小车（202）和第一导轨（203），所述第一导轨（203）固定安装在所述第一底座（21）上；所述第二直线电机（20’）包括相互配合的第二小车（202’）和第二导轨（203’），所述第二导轨（203’）固定安装在所述方型支架（1）上；
所述第一直线电机（20）和所述第二直线电机（20’）空间上十字交叉叠放，所述第一底座（21）固定安装在所述第二小车（202’）的顶部；所述法兰（5）固定安装在第一小车（202）的顶部，所述摆杆部分（3）与所述法兰（5）连接；
所述第一直线电机（20）提供X轴方向运动，所述第二直线电机（20’）提供Y轴方向运动，所述第一直线电机（20）和所述第二直线电机（20’）的合成运动提供水平面内任意方向的直线运动；
所述第一小车（202）上设有第一线性编码器（205），所述第一导轨（203）上设有与所述第一线性编码器（205）相对应的第一磁栅（206）；所述第二小车（202’）上设有第二线性编码器（205’），所述第二导轨（203’）上设有与所述第二线性编码器（205’）相对应的第二磁栅（206’）；
所述摆杆部分（3）内设有姿态传感器；
所述第一直线电机（20）和所述第二直线电机（20’）结构相同；
所述第一导轨（203）的截面呈U形槽状，且所述第一导轨（203）的槽口位于竖直方向上的一侧面；所述第一小车（202）呈倒U形块状，所述第一小车（202）跨设在所述第一导轨（203）上；所述第一直线电机（20）进一步包括第一直线电机定子（200）以及第一直线电机动子（201）；所述第一直线电机定子（200）均匀分布在第一导轨（203）的槽口内上下两侧的水平内壁上；第一直线电机动子（201）一端固定于所述第一小车（202）的一侧直立内壁上；第一直线电机动子（201）的另一端配合位于第一导轨（203）的槽口内，且与第一直线电机定子（200）相对应；
所述第一线性编码器（205）设置在所述第一小车（202）远离所述第一导轨（203）槽口的一侧直立内壁上，所述第一磁栅（206）设置在所述第一导轨（203）远离槽口的直立外壁上；
所述第二导轨（203’）的截面呈U形槽状，且所述第二导轨（203’）的槽口位于竖直方向上的一侧面；所述第二小车（202’）呈倒U形块状，所述第二小车（202’）跨设在所述第二导轨（203’）上；所述第二直线电机（20’）进一步包括第二直线电机定子（200’）以及第二直线电机动子（201’）；所述第二直线电机定子（200’）均匀分布在第二导轨（203’）的槽口内上下两侧的水平内壁上；第二直线电机动子（201’）一端固定于所述第二小车（202’）的一侧直立内壁上；第二直线电机动子（201’）的另一端配合位于第二导轨（203’）的槽口内，且与第二直线电机定子（200’）相对应；
所述第二线性编码器（205’）设置在所述第二小车（202’）远离所述第二导轨（203’）槽口的一侧直立内壁上，所述第二磁栅（206’）设置在所述第二导轨（203’）远离槽口的直立外壁上；
所述第一导轨（203）的顶部设置有小导轨（204），小导轨长度方向的两侧设置有浅槽，与小导轨对应的小车的内侧顶部设置有槽钢状的固定板(2020)，所述固定板(2020)的槽口内两侧面上设置有凸条和小导轨上浅槽向配合，保证小车沿导轨直线移动；
所述第二导轨（203’）的顶部设置有第二导轨（204’），小导轨长度方向的两侧设置有浅槽，与小导轨对应的小车的内侧顶部设置有槽钢状的固定板(2020’)，所述固定板(2020’)的槽口内两侧面上设置有凸条和小导轨上浅槽向配合，保证小车沿导轨直线移动；
所述方型支架（1）由一对工型导轨（11）、一对L型支撑座（10）以及一对U型底座（12）组成，所述工型导轨（11）、L型支撑座（10）以及U型底座（12）都是呈平行放置，所述工型导轨（11）与L型支撑座（10）垂直放置，U型底座（12）和工型导轨（11）相配合；
所述摆杆部分（3）包括摆杆（31）、球铰链座（30）、姿态传感器支架（32），所述摆杆（31）底端设置有球体，可嵌入球铰链座（30）并且旋转运动；所述姿态传感器支架（32）用于安装姿态传感器，球铰链支架（30）通过法兰（5）与上方直线电机（20）底座相连接；
适用于所述一种平面运动倒立摆的控制系统包括：依次通信连接的监测计算机、DSP控制器、电机驱动器；所述DSP控制器分别与所述第一线性编码器（205）、所述第二线性编码器（205’）和所述姿态传感器通信连接，所述电机驱动器分别与所述第一直线电机（20）、第二直线电机（20’）连接；其中：
所述第一线性编码器（205）用于：实时采集所述第一直线电机（20）中第一小车（202）
的位移信号，即第一位移信号；
所述第二线性编码器（205’）用于：实时采集所述第二直线电机（20’）中第二小车（202’）
的位移信号，即第二位移信号；
所述姿态传感器用于：实时采集所述摆杆部分（3）的摆杆姿态信号；所述摆杆姿态信号具体包括：摆杆角度信号、倾倒方向信号；
所述DSP控制器用于：实时接收所述第一位移信号、第二位移信号、摆杆姿态信号，并进行计算和处理，获得控制量输出数据，并输出相应的PWM信号给电机驱动器；
所述电机驱动器用于：实时接收相应的两路PWM信号分别驱动控制第一直线电机（20）、第二直线电机（20’）运动，进而控制摆杆（31）的运动状态；
所述监测计算机用于接收来自DSP控制器的数据，包括摆杆的倾角、倾倒方位、第一直线电机速度、第二直线电机速度；
所述控制系统实现倒立摆运动控制的操作步骤如下：
步骤S1，利用所述第一线性编码器（205）实时采集所述第一直线电机（20）中第一小车（202）的位移信号，即第一位移信号；利用所述第二线性编码器（205’）实时采集所述第二直线电机（20’）中第二小车（202’）的位移信号，即第二位移信号；
步骤S2，利用所述姿态传感器实时采集所述摆杆部分（3）的摆杆姿态信号；所述摆杆姿态信号具体包括：摆杆角度信号、倾倒方向信号；
步骤S3，利用所述DSP控制器实时接收所述第一位移信号、第二位移信号、摆杆姿态信号，并进行计算和处理，获得控制量输出数据，并输出相应的PWM信号给电机驱动器；
步骤S4，利用所述电机驱动器实时接收相应的两路PWM信号分别驱动控制X轴方向第一直线电机（20）、Y轴方向第二直线电机（20’）运动，进而控制摆杆（31）的运动状态。
2.根据权利要求1所述的一种平面运动倒立摆，其特征在于：所述第一直线电机（20）和第二直线电机（20’）均为无铁心永磁同步直线电机。
3.根据权利要求1所述的一种平面运动倒立摆，其特征在于：所述L型支撑座（10）和底座(21)上均设置有防撞块（4），防撞块（4）的材料为橡胶。
4.根据权利要求1所述的一种平面运动倒立摆，其特征在于：
所述DSP控制器的主控芯片型号为TMS320F28335；所述姿态传感器包括三轴陀螺仪和三轴磁力计，其中，所述陀螺仪用于测量摆杆与竖直方向的夹角，所述磁力计用于测量摆杆倾倒的方向。
5.根据权利要求1所述的一种平面运动倒立摆，其特征在于，在步骤S3中，所述DSP控制器的计算和处理过程具体包括：所述DSP控制器根据所述第一位移信号、第二位移信号、摆杆姿态信号计算获得摆杆状态数据，所述摆杆状态数据包括：摆杆与竖直方向的角度、倾倒的角速度、X轴方向位移和速度、Y轴方向位移和速度、倾倒的方向与X轴方向夹角；所述DSP控制器进一步根据所述摆杆状态数据进行处理，获得控制量输出数据给电机驱动器。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810239295.6A CN108279696B (zh) | 2018-03-22 | 2018-03-22 | 一种平面运动倒立摆及其控制系统和控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810239295.6A CN108279696B (zh) | 2018-03-22 | 2018-03-22 | 一种平面运动倒立摆及其控制系统和控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN108279696A CN108279696A (zh) | 2018-07-13 |
| CN108279696B true CN108279696B (zh) | 2024-04-12 |
Family
ID=62810142
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810239295.6A Active CN108279696B (zh) | 2018-03-22 | 2018-03-22 | 一种平面运动倒立摆及其控制系统和控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108279696B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110500981B (zh) * | 2019-07-24 | 2021-08-10 | 武汉武建机械施工有限公司 | 一种在监测领域内避免受初始安装夹角影响的传感器装置 |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101286280A (zh) * | 2007-04-28 | 2008-10-15 | 赵建萍 | 直线电机倒立摆 |
| CN201323018Y (zh) * | 2008-12-29 | 2009-10-07 | 杭州电子科技大学 | 摆杆重心扰动倒立摆装置 |
| CN102237006A (zh) * | 2011-05-12 | 2011-11-09 | 北京工业大学 | 一种基于反力矩旋转机构的倒立摆系统 |
| CN102394024A (zh) * | 2011-07-14 | 2012-03-28 | 杭州电子科技大学 | 快速平面运动平台 |
| CN102880181A (zh) * | 2012-09-06 | 2013-01-16 | 中山大学 | 一种倒立摆系统及其控制电路和控制方法 |
| CN203644296U (zh) * | 2014-01-17 | 2014-06-11 | 渤海大学 | 平面二维自由度旋转倒立摆装置 |
| CN105608980A (zh) * | 2016-03-04 | 2016-05-25 | 合肥工业大学智能制造技术研究院 | 一种直线电机倒立摆 |
| CN107363852A (zh) * | 2017-07-18 | 2017-11-21 | 武汉理工大学 | 一种搭载平面倒立摆的全向移动机器人及控制方法 |
| CN208224846U (zh) * | 2018-03-22 | 2018-12-11 | 安徽合动智能科技有限公司 | 一种平面运动倒立摆 |
-
2018
- 2018-03-22 CN CN201810239295.6A patent/CN108279696B/zh active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101286280A (zh) * | 2007-04-28 | 2008-10-15 | 赵建萍 | 直线电机倒立摆 |
| CN201323018Y (zh) * | 2008-12-29 | 2009-10-07 | 杭州电子科技大学 | 摆杆重心扰动倒立摆装置 |
| CN102237006A (zh) * | 2011-05-12 | 2011-11-09 | 北京工业大学 | 一种基于反力矩旋转机构的倒立摆系统 |
| CN102394024A (zh) * | 2011-07-14 | 2012-03-28 | 杭州电子科技大学 | 快速平面运动平台 |
| CN102880181A (zh) * | 2012-09-06 | 2013-01-16 | 中山大学 | 一种倒立摆系统及其控制电路和控制方法 |
| CN203644296U (zh) * | 2014-01-17 | 2014-06-11 | 渤海大学 | 平面二维自由度旋转倒立摆装置 |
| CN105608980A (zh) * | 2016-03-04 | 2016-05-25 | 合肥工业大学智能制造技术研究院 | 一种直线电机倒立摆 |
| CN107363852A (zh) * | 2017-07-18 | 2017-11-21 | 武汉理工大学 | 一种搭载平面倒立摆的全向移动机器人及控制方法 |
| CN208224846U (zh) * | 2018-03-22 | 2018-12-11 | 安徽合动智能科技有限公司 | 一种平面运动倒立摆 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN108279696A (zh) | 2018-07-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109515769B (zh) | 多星悬吊式微重力模拟系统 | |
| Kim et al. | High-precision magnetic levitation stage for photolithography | |
| CN106426089B (zh) | 柔性三自由度并联机构振动检测控制装置及控制方法 | |
| EP0241883B1 (en) | Plural robotic drive | |
| US8983792B2 (en) | Indoor testing device for a plurality of rotor-containing flying objects | |
| CN106292741A (zh) | 一种基于无刷电机的移动机器人云台系统 | |
| CN110060552B (zh) | 一种卫星星座轨道物理仿真实验平台 | |
| CN113479355B (zh) | 地面变质心零重力模拟装置及模拟方法 | |
| CN104097200A (zh) | 机械手、机械手控制装置以及机械手系统 | |
| JP7248361B1 (ja) | 並列接続型姿勢調整に基づく惑星ローバー磁気浮上重力補償実験プラットフォーム | |
| CN103846649A (zh) | 一种用于精密装配的两级并联机器人装置 | |
| CN113788082B (zh) | 一种可重构球形机器人、控制系统及其控制方法 | |
| CN112311192B (zh) | 一种基于磁悬浮平面电机的物流装置及其控制方法 | |
| CN108279696B (zh) | 一种平面运动倒立摆及其控制系统和控制方法 | |
| CN111506118B (zh) | 一种使用正交解耦力矩驱动的三自由度光电吊舱 | |
| Liegeois et al. | Learning and control for a compliant computer-controlled manipulator | |
| CN114603603B (zh) | 空间机械臂在轨操作的地面模拟装置及模拟方法 | |
| CN114185271B (zh) | 一种环形桁架三维随动系统及其控制方法 | |
| CN112019104B (zh) | 一种步进电机驱动方法、步进电机驱动装置及小型机械臂 | |
| CN113848751A (zh) | 一种无拖曳航天器的地面模拟系统 | |
| Songyi et al. | Development of a self-balance dual-arm robot for inspection of high-voltage power transmission lines | |
| Inou et al. | Group Robots Forming a Mechanical Structure-Development of slide motion mechanism and estimation of energy consumption of the structural formation | |
| CN109709822B (zh) | 一种大尺度柔性航天器整星地面半物理试验装置 | |
| OzgUner et al. | Laboratory facility for flexible structure control experiments | |
| CN113911407A (zh) | 一种基于绳系的力跟随地外天体低重力环境模拟着陆试验系统 |
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 | ||
| TA01 | Transfer of patent application right | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20240315 Address after: Room 108, Building 7, Yousi Tiancheng Industrial Park, No. 1800 Dabieshan Road, High tech Zone, Hefei City, Anhui Province, 230031 Applicant after: HEFEI ZHONGKE SHENGU TECHNOLOGY DEVELOPMENT CO.,LTD. Country or region after: China Address before: No. 8 Huayuan Avenue, Baohe Economic Development Zone, Hefei City, Anhui Province, 230009 Applicant before: ANHUI HOPEMOTION CO.,LTD. Country or region before: China |
|
| GR01 | Patent grant | ||
| GR01 | Patent grant |