小型自平衡机器人姿态模拟器制造技术

本发明专利技术涉及一种小型自平衡机器人姿态模拟器，属于机器人姿态运动仿真、惯导设备检测领域；小型自平衡机器人姿态模拟器可以模拟自平衡机器人的俯仰角、航向角的变化；同时水平移动滑台和两轴转台运动的叠加亦可以模拟两轮自平衡机器人在水平面上复杂的运动姿态，包括自旋、匀速转向、机器人走“8”字；采用非线性PD双回路控制器使姿态模拟器系统稳定性增强，同时提高了控制精度；L型外框的使用，减少了系统的重力不平衡力矩、提高系统精度。

【技术实现步骤摘要】
小型自平衡机器人姿态模拟器
本专利技术涉及一种小型自平衡机器人姿态模拟器，属于机器人姿态运动模拟仿真、惯导设备检测领域。
技术介绍
自平衡机器人是一种质心高于支点,在重力作用下机身姿态本征不稳定的移动机器人，在运动中需要自身控制姿态维持平衡。提高自平衡机器人的运动姿态控制性能，首要提供的是姿态模拟平台，模拟自平衡机器人的运功姿态，验证姿态检测算法和传感器的性能。姿态模拟器主要用于惯导设备测试和半实物仿真测试，应用于半实物仿真测试的姿态模拟器被称作仿真转台。转台是仿真技术的关键设备,由早期的单轴转台到目前的三轴转台,已经可以真实地模拟导弹或飞行器的动力学特性,在实验室条件下复现其在空中的各种飞行姿态,对导弹或飞行器的传感器件、制导系统和控制系统及各执行机构的性能加以测试，为成功的实际飞行提供充分的技术指标和实验数据。因此为了能够在自平衡机器人领域，实现通过实验仿真机器人的各种复杂的运动姿态，验证姿态控制算法和机身上的姿态传感器性能的目的，本专利技术提出了一种小型自平衡姿态模拟器。
技术实现思路
本专利技术的目的在于提供一种小型自平衡机器人姿态模拟器，该模拟器不但可以仿真小型自平衡机器人的俯仰角、航向角的变化，还可以通过导轨滑台水平移动和两轴转台部分两轴系运动的叠加仿真两轮自平衡机器人在水平面上复杂的运动姿态，包括自旋、匀速转向、机器人走“8”字等，并可作为类似相关运动仿真的试验平台。为实现上述目的，本专利技术采用的技术方案为一种小型自平衡机器人姿态模拟器，该模拟器包括一个水平移动平台和一个两轴转台；其中，两轴转台部分，上轴系模拟自平衡机器人的俯仰姿态，下轴系模拟自平衡机器人的航向角，安装于水平移动平台的导轨滑台上；水平移动平台驱动导轨滑台，实现两轴转台进行水平位移，模拟机器人在空间的水平移动；通过步进电机细分驱动器提高步进电机的步距精度，上轴系采用由步进电机直接驱动支撑架，并由光电编码器组成闭环系统，避免产生失步，提高俯仰姿态的仿真精度；中层电机采用力矩较大的减速步进电机驱动L型框架，不加传动装置，减少定位误差，提高航向角的仿真精度；下层电机由步进电机驱动丝杆，丝杆将回转运动转化为导轨滑台的直线运动，并由光电编码器组成闭环系统，提高位移精度。与现有技术先比，本专利技术具有如下有益效果。小型自平衡机器人姿态模拟器可以模拟小型自平衡机器人的俯仰角、航向角的变化；同时水平移动滑台和两轴转台运动的叠加亦可以模拟两轮自平衡机器人在水平面上复杂的运动姿态，包括自旋、匀速转向、机器人走“8”字；采用非线性PD双回路控制器使姿态模拟器系统稳定性增强，同时提高了控制精度；L型外框的使用，减少了系统的重力不平衡力矩、提高系统精度。附图说明图1为小型自平衡机器人姿态模拟器的机械结构立体示意图。图2为导轨滑台机械结构示意图。图3为L型外框与中轴安装架结构图。图4为固定平台的结构示意框图。图5为电气系统结构示意图。图中：1、底座，2、下层电机驱动器，3、联轴器，4、固定平台，5、L型外框，6、姿态传感器，7、支撑杆，8、导轨滑台，9、丝杆，10、导轨底座，11、开关电源，12、电源分配器，13、DSP控制器，14、上层电机，15、光电编码器a，16、中层电机，17、下层电机，18、中层安装架，19、上层安装架，20、中层电机驱动器，21、上层电机驱动器，22、光电编码器b，23、滚动轴承，24、滑轮。具体实施方式下面结合附图和具体实施方式对本专利技术作进一步说明。如图1、图2、图3、图4所示，一种小型自平衡机器人姿态模拟器，该模拟器包括底座1、下层电机驱动器2、联轴器3、固定平台4、L型外框5、姿态传感器6、支撑杆7、导轨滑台8、丝杆9、导轨底座10、开关电源11、电源分配器12、DSP控制器13、上层电机14、光电编码器a15、中层电机16、下层电机17、中层安装架18、上层安装架19、中层电机驱动器20、上层电机驱动器21、光电编码器b22、滚动轴承23、滑轮24。其中，导轨底座10、下层电机驱动器2、中层电机驱动器20、上层电机驱动器21、DSP控制器13、开关电源11、电源分配器12均直接固定在底座1上。导轨底座10上安装有丝杆9、下层电机17、滚动轴承23，导轨底座10两端通过螺栓连接固定在底座1上，丝杆9与导轨底座10通过滚珠轴承23固定在导轨底座10上，下层电机17一端与光电编码器b22相连，另一端通过联轴器3与丝杆9相连；丝杆9与导轨滑台8内的螺纹孔通过螺纹配合连接在一起；导轨滑台8下端安装有滑轮24，其与导轨底座10轨道吻合，起支撑导轨滑台8的作用。支撑杆7下端连接导轨滑台8，支撑杆7上端与固定平台4连接，保证固定平台4与导轨滑台8平行。固定平台4下端通过四个预留的螺纹孔与中层电机16通过螺栓连接固定，固定平台4中心留有中心孔；中层电机16与导轨滑台8垂直；中层安装架18置于固定平台4上，中层安装架18的轴穿过固定平台4的中心孔与中层电机16相连；中层电机16直接驱动中层安装架18转动；同时为了布线方便，在固定平台4上预留有布线孔。L型外框5固定在中层安装架18上，L型外框5底部设有对称的长形孔，螺钉穿过长孔与中层安装架18上预留的螺纹孔固定；同时长形孔的设计可以使L型外框5可以沿长形孔方向，调节其在中层安装架18上的位置；L型外框5的侧板预留有轴孔，轴孔周围是四个螺纹孔，并与上层电机14的安装孔对应，通过螺钉将上层电机14固定在L型外框5的内侧，上层电机14的电机轴穿过L型外框5的轴孔固定上层安装架19；上层安装架19用来安装姿态传感器6。上层电机14、中层电机16、下层电机17均采用步进电机。光电编码器a15、光电编码器b22分别与上层电机14、下层电机17相连，用以测量上层电机14、下层电机17转过的角度，作为闭环反馈，防止步进电机失步。上层电机14直接驱动上层安装架19，使上层安装架19能够围绕水平线做旋转运动，模拟自平衡机器人的俯仰姿态；中层电机16驱动中层安装架18，带动L型外框5及上层电机14转动，模拟自平衡机器人航向姿态；下层电机17通过丝杆驱动导轨滑台8做水平位移模拟自平衡机器人的空间水平移动。DSP控制器13输出非线性PD双回路控制的占空比可调的PWM波，控制步进下层电机驱动器2、中层电机驱动器20、上层电机驱动器21，使上层电机14、中层电机16、下层电机17按照程序编定的步骤转动。光电编码器a15、光电编码器b22，监测上、下层电机的旋转角度，如有失步需及时补足；同时将编码器所测量得到的电机速度反馈给DSP控制器13，作为控制模拟器电机速度的线性PD控制器的参考量。姿态传感器6是模拟自平衡机器人运动姿态的关键器件，系统运动状态可以由姿态传感器6中各轴向陀螺仪测量的角速度、加速度计测量的加速度的值来直观的显示；同时姿态传感器6将测量得到的数值反馈到DSP控制器13，作为控制模拟器各轴向转动角度的非线性PD控制器部分的参考量。电源分配器12含有高频电源模块，电源分配器12可以输出稳定的直流电为基础电路供电。丝杆9将回转运动转化为导轨滑台8的直线运动，滚动轴承23将丝杆9的滚动摩擦变为滑动摩擦，减小的摩擦阻力。L型外框5可以减少姿态模拟器的惯性载荷，重力不平衡载荷；一般设计中所采用的U型外框本文档来自技高网...

【技术保护点】
一种小型自平衡机器人姿态模拟器，其特征在于：该模拟器包括底座（1）、下层电机驱动器（2）、联轴器（3）、固定平台（4）、L型外框（5）、姿态传感器（6）、支撑杆（7）、导轨滑台（8）、丝杆（9）、导轨底座（10）、开关电源（11）、电源分配器（12）、DSP控制器（13）、上层电机（14）、光电编码器a（15）、中层电机（16）、下层电机（17）、中层安装架（18）、上层安装架（19）、中层电机驱动器（20）、上层电机驱动器（21）、光电编码器b（22）、滚动轴承（23）、滑轮（24）；其中，导轨底座（10）、下层电机驱动器（2）、中层电机驱动器（20）、上层电机驱动器（21）、DSP控制器（13）、开关电源（11）、电源分配器（12）均直接固定在底座（1）上；导轨底座（10）上安装有丝杆（9）、下层电机（17）、滚动轴承（23），导轨底座（10）两端通过螺栓连接固定在底座（1）上，丝杆（9）与导轨底座（10）通过滚珠轴承（23）固定在导轨底座（10）上，下层电机（17）一端与光电编码器b（22）相连，另一端通过联轴器（3）与丝杆（9）相连；丝杆（9）与导轨滑台（8）内的螺纹孔通过螺纹配合连接在一起；导轨滑台（8）下端安装有滑轮（24），其与导轨底座（10）轨道吻合，起支撑导轨滑台（8）的作用；支撑杆（7）下端连接导轨滑台（8），支撑杆（7）上端与固定平台（4）连接，保证固定平台（4）与导轨滑台（8）平行；固定平台（4）下端通过四个预留的螺纹孔与中层电机（16）通过螺栓连接固定，固定平台（4）中心留有中心孔；中层电机（16）与导轨滑台（8）垂直；中层安装架（18）置于固定平台（4）上，中层安装架（18）的轴穿过固定平台（4）的中心孔与中层电机（16）相连；中层电机（16）直接驱动中层安装架（18）转动；同时为了布线方便，在固定平台（4）上预留有布线孔；L型外框（5）固定在中层安装架（18）上，L型外框（5）底部设有对称的长形孔，螺钉穿过长孔与中层安装架（18）上预留的螺纹孔固定；同时长形孔的设计可以使L型外框（5）可以沿长形孔方向，调节其在中层安装架（18）上的位置；L型外框（5）的侧板预留有轴孔，轴孔周围是四个螺纹孔，并与上层电机（14）的安装孔对应，通过螺钉将上层电机（14）固定在L型外框（5）的内侧，上层电机（14）的电机轴穿过L型外框（5）的轴孔固定上层安装架（19）；上层安装架（19）用来安装姿态传感器（6）；电气系统分为控制模块、姿态检测模块、执行模块、电源模块；其中电源模块为其它部分提供稳定的直流电源，控制模块发出指令控制执行模块中的步进电机按照程序编写的方式运行，并由编码器组成反馈回路；系统运动时各方向姿态角的变化，均由姿态检测模块测量，并上传上位机进行分析；同时数据反馈到DSP控制器，组成控制回路。...

【技术特征摘要】
1.一种小型自平衡机器人姿态模拟器，其特征在于：该模拟器包括底座(1)、下层电机驱动器(2)、联轴器(3)、固定平台(4)、L型外框(5)、姿态传感器(6)、支撑杆(7)、导轨滑台(8)、丝杆(9)、导轨底座(10)、开关电源(11)、电源分配器(12)、DSP控制器(13)、上层电机(14)、光电编码器a(15)、中层电机(16)、下层电机(17)、中层安装架(18)、上层安装架(19)、中层电机驱动器(20)、上层电机驱动器(21)、光电编码器b(22)、滚动轴承(23)、滑轮(24)；其中，导轨底座(10)、下层电机驱动器(2)、中层电机驱动器(20)、上层电机驱动器(21)、DSP控制器(13)、开关电源(11)、电源分配器(12)均直接固定在底座(1)上；导轨底座(10)上安装有丝杆(9)、下层电机(17)、滚动轴承(23)，导轨底座(10)两端通过螺栓连接固定在底座(1)上，丝杆(9)与导轨底座(10)通过滚珠轴承(23)固定在导轨底座(10)上，下层电机(17)一端与光电编码器b(22)相连，另一端通过联轴器(3)与丝杆(9)相连；丝杆(9)与导轨滑台(8)内的螺纹孔通过螺纹配合连接在一起；导轨滑台(8)下端安装有滑轮(24)，其与导轨底座(10)轨道吻合，起支撑导轨滑台(8)的作用；支撑杆(7)下端连接导轨滑台(8)，支撑杆(7)上端与固定平台(4)连接，保证固定平台(4)与导轨滑台(8)平行；固定平台(4)下端通过四个预留的螺纹孔与中层电机(16)通过螺栓连接固定，固定平台(4)中心留有中心孔；中层电机(16)与导轨滑台(8)垂直；中层安装架(18)置于固定平台(4)上，中层安装架(18)的轴穿过固定平台(4)的中心孔与中层电机(16)相连；中层电机(16)直接驱动中层安装架(18)转动；同时为了布线方便，在固定平台(4)上预留有布线孔；L型外框(5)固定在中层安装架(18)上，L型外框(5)底部设有对称的长形孔，螺钉穿过长孔与中层安装架(18)上预留的螺纹孔固定；同时长形孔的设计可以使L型外框(5)可以沿长形孔方向，调节其在中层安装架(18)上的位置；L型外框(5)的侧板预留有轴孔，轴孔周围是四个螺纹孔，并与上层电机(14)的安装孔对应，通过螺钉将上层电机(14)固定在L型外框(5)的内侧，上层电机(14)的电机轴穿过L型外框(5)的轴孔固定上层安...

【专利技术属性】
技术研发人员：阮晓钢，于淼淼，于乃功，马圣策，孙荣毅，张晓平，魏若岩，李望博，
申请(专利权)人：北京工业大学，
类型：发明
国别省市：