一种自动控制的动态平衡双轮机器人制造技术

本实用新型专利技术公开了一种自动控制的动态平衡双轮机器人，主要包括前平衡板、后摇摆板、前惰轮、后惰轮、丝杆、丝杆固定座、丝杆电机、减速电机、连接块、传感器组、电池组和控制器。控制方法包括：首先通过环境探测传感器检测并收集周围的信息，生成当前环境下最优的移动路径；然后通过减速电机驱动前平衡板和后摇摆板往相反的方向摆动，机器人保持平衡并向前运动；当需要转弯时，控制器驱动丝杆电机向左或向右移动，使前平衡板向左或向右倾斜，减速电机配合丝杆电机驱动后摇摆板向相反方向倾斜并锁定一段时间，直到机器人完成转弯后，丝杆电机和减速电机才复位。本实用新型专利技术的结构简单、控制逻辑清晰，具有自动平衡、转弯效率高和移动灵活的优点。

【技术实现步骤摘要】
一种自动控制的动态平衡双轮机器人
本技术涉及娱乐和机器人
，尤其涉及一种通过自动控制可以实现动态平衡的双轮机器人。
技术介绍
目前出现的两轮自平衡小车均以两轮呈左右排布，这种排布的小车宽度较大，其排布方式并不适用于狭窄区域内灵活移动。而现有的自行车机器人虽然两轮前后排布，但其仅依靠前轮进行转向，后轮被动进行转弯，难以适应狭窄区域内高效灵活的转弯需求。
技术实现思路
本技术的目的在于克服现有技术的不足，提供一种转弯效率高，可以自动平衡而且能够在狭窄区域内灵活移动的双轮机器人。本技术的目的通过下述技术方案实现：一种自动控制的动态平衡双轮机器人，主要包括前平衡板、后摇摆板、前惰轮、后惰轮、丝杆、丝杆固定座、丝杆电机、减速电机、连接块、传感器组、电池组和控制器。所述前惰轮与前平衡板连接，可绕前平衡板转动，所述后惰轮与后摇摆板连接，可绕后摇摆板转动。所述丝杆通过丝杆固定座安装在前平衡板上，丝杆的轴线与机器人的前进方向垂直，所述丝杆电机安装在丝杆上，与丝杆传动连接，通过丝杆电机的正反转可使丝杆电机在丝杆上往复移动，由于丝杆电机自身带有一定的重量，当丝杆电机在丝杆上移动时，会改变前平衡板的重心位置，使前平衡板向左或向右倾斜，从而实现通过改变前平衡板的重心达到转弯的目的。所述减速电机和电池组安装在后摇摆板上，连接块安装在前平衡板上，所述减速电机的输出轴与连接块固定，使前平衡板与后摇摆板建立连接，并在减速电机的驱动下摇摆前进。所述控制器安装在前平衡板上，分别与丝杆电机、减速电机、传感器组和电池组连接，用于控制减速电机，并接收传感器组的反馈数据。作为本技术的优选方案，所述丝杆和丝杆电机均安装在前平衡板的底部位置，这样的设计有三个作用：一是增加前平衡板的重量，使其重心降低，并提高前惰轮与地面的摩擦力，有效提高双轮机器人转弯的稳定性；二是丝杆电机的移动会改变前平衡板的重心，使前平衡板向左或向右倾斜，减速电机驱动后摇摆板往相反的方向倾斜即可以实现高效转弯操作；三是通过控制丝杆电机在丝杆上的位置，就可以控制前平衡板重心的偏移量，从而控制双轮机器人的转弯半径，可以有效提高双轮机器人的转弯效率，使其在狭窄区域能够灵活、自由移动，直线前进时也可以通过丝杆电机配合减速电机的摆动幅度增加前进的动力，同时还可以节省时间，提高控制器的控制效率。进一步的，所述丝杆和丝杆电机也可以安装在后摇摆板上，实现相同的功能，扩大双轮机器人的应用范围，降低双轮机器人的安装要求。具体的，所述传感器组包括用于监测机器人姿势的第一陀螺仪和第二陀螺仪、用于测量惰轮转向角度的第一转角传感器和第二转角传感器、以及用于测量惰轮速度的第一转速传感器和第二转速传感器。所述第一陀螺仪和第二陀螺仪分别安装在前平衡板和后摇摆板上，在工作时，用于监测双轮机器人的摇摆姿态。所述第一转角传感器和第二转角传感器分别安装在前平衡板与前惰轮的连接处和后摇摆板与后惰轮的连接处，监测前惰轮和后惰轮的转动角度，用于转弯的辅助判断。所述第一转速传感器和第二转速传感器分别安装在前惰轮和后惰轮的转轴上，检测前惰轮和后惰轮的转速，用于判断机器人当前的车速及调整减速电机的转动频率。所述控制器分别与第一陀螺仪、第二陀螺仪、第一转角传感器、第二转角传感器、第一转速传感器和第二转速传感器连接，接收传感器的反馈数据，用于规划双轮机器人的运动路径，并协调丝杆电机和减速电机的输出。进一步的，为了使双轮机器人能在狭窄区域内自由、高效地移动，所述传感器组还包括用于定位和导航的环境探测传感器，所述环境探测传感器安装在前平衡板的上面，与控制器连接，该环境探测传感器位于机器人的前端，便于快速识别前进方向的障碍物。该环境探测传感器主要用于探测机器人周围的障碍物，通过控制器的分析和处理，获得当前环境下可供移动的区域，并对机器人本身处于可移动区域的位置进行定位，通过分析和规划从而进一步获得双轮机器人在该区域内移动的最优路径。作为本技术的优选方案，该环境探测传感器可以采用深度相机对周围环境的信息进行采集，并反馈到控制器处进行处理。作为本技术的优选方案，所述丝杆、丝杆电机、减速电机、连接块和电池组均安装在机器人的下方，这样设计降低了整机的重心，有利于提高双轮机器人在行驶中的稳定性和平衡性，同时给双轮机器人的上方留有更多可供使用的空间。进一步的，所述减速电机和连接块的安装位置可互换，同样可以实现相同的功能，起相同的作用。作为本技术的优选方案，所述前惰轮的转向轴线与前平衡板平面倾斜，所述后惰轮的转向轴线与后摇摆板平面倾斜。该倾斜结构可以实现前平衡板和后摇摆板在摆动时，前后惰轮受到压迫向特定方向转动，可以提高双轮机器人的转动效率的目的。作为本技术的优选方案，所述减速电机采用运行稳定、控制精度高、抗过载能力强的伺服电机作为驱动。一种自动控制的动态平衡双轮机器人的控制方法，该方法主要包括如下步骤：步骤S1:双轮机器人上电启动，丝杆电机和减速电机复位，并使前平衡板和后摇摆板恢复到水平状态。步骤S2:控制器与传感器通信并检测所有传感器(陀螺仪、转角传感器、转速传感器、环境探测传感器)是否正常，若出现故障，丝杆电机和减速电机则不工作，直到故障修复为止。步骤S3:伺服电机和丝杆电机启动，根据控制器的指令工作，使双轮机器人保持平衡，并执行前进、加速和转弯操作。其中，所述步骤S3还包括如下步骤：步骤S31:当控制器检测到当前速度低于设定值时，则调整减速电机的输出，加快双轮机器人的摇摆频率和提高摆动幅度，以此来提高双轮机器人的速度。同时，通过丝杆电机调整前平衡板的重心位置来配合减速电机，有助于双轮机器人实现更快、更高效率的加速。步骤S32:当环境探测传感器检测到前方有障碍物，需要执行转弯操作时，控制器则驱动丝杆电机移动到转向的一侧，使前平衡板向转弯一侧倾斜，伺服电机驱动后摇摆板向转向的另一侧倾斜，并锁定伺服电机使前平衡板和后摇摆板的姿态保持一定时间，直到转弯结束。本技术的工作过程和原理是：本技术所提供的双轮机器人首先通过环境探测传感器检测并收集周围的信息，并对这些信号加以分析和处理，生成当前环境下最优的移动路径，或通过程序设定固定的运动路径；然后控制器通过减速电机驱动前平衡板和后摇摆板往相反的方向摆动，使机器人保持平衡并向前运动；当需要转弯时，控制器驱动丝杆电机向左或向右移动，使前平衡板向左或向右倾斜，减速电机配合丝杆电机驱动后摇摆板向相反方向倾斜并锁定一段时间，直到机器人完成转弯后，丝杆电机和减速电机才复位。本技术的结构简单、控制逻辑清晰，具有自动平衡、转弯效率高和移动灵活的优点。与现有技术相比，本技术还具有以下优点：(1)本技术提供的双轮机器人重心低，能够有效提高摆动时的稳定性，显著改善机器人的平衡效果。(2)本技术通过陀螺仪来监测双轮机器人的摆动状态，控制器时刻分析并调整减速电机的输出，让双轮机器人保持平衡状态。(3)本技术采用深度相机作为探测周围环境的传感器，能有效感知周围环境的障碍物，为机器人移动路径的规划提供很好的帮助。(4)本技术采用丝杆电机改变前平衡板重心的方法来实现双轮机器人高效转弯、直线提速的目的。(5)本技术通过改变丝杆电机在前平衡板上的位置即可调整前平衡本文档来自技高网...

【技术保护点】
一种自动控制的动态平衡双轮机器人，其特征在于，包括前平衡板、后摇摆板、前惰轮、后惰轮、丝杆、丝杆固定座、丝杆电机、减速电机、连接块、传感器组、电池组和控制器；所述前惰轮与前平衡板连接，可绕前平衡板转动，所述后惰轮与后摇摆板连接，可绕后摇摆板转动；所述丝杆通过丝杆固定座安装在前平衡板上，与机器人的前进方向垂直，所述丝杆电机安装在丝杆上，可沿丝杆往复移动，并通过改变前平衡板的重心来实现转弯操作；所述减速电机和电池组安装在前平衡板上，连接块安装在后摇摆板上，所述减速电机的输出轴与连接块固定，使前平衡板与后摇摆板建立连接，并在减速电机的驱动下摇摆前进；所述控制器安装在前平衡板上，分别与丝杆电机、减速电机、传感器组和电池组连接；所述传感器组包括用于监测机器人姿势的第一陀螺仪和第二陀螺仪、用于测量惰轮转向角度的第一转角传感器和第二转角传感器、以及用于测量惰轮速度的第一转速传感器和第二转速传感器；所述第一陀螺仪和第二陀螺仪分别安装在前平衡板和后摇摆板上；所述第一转角传感器和第二转角传感器分别安装在前平衡板与前惰轮的连接处和后摇摆板与后惰轮的连接处；所述第一转速传感器和第二转速传感器分别安装在前惰轮和后惰轮的转轴上；所述控制器分别与第一陀螺仪、第二陀螺仪、第一转角传感器、第二转角传感器、第一转速传感器和第二转速传感器连接，接收传感器的反馈数据。...

【技术特征摘要】
1.一种自动控制的动态平衡双轮机器人，其特征在于，包括前平衡板、后摇摆板、前惰轮、后惰轮、丝杆、丝杆固定座、丝杆电机、减速电机、连接块、传感器组、电池组和控制器；所述前惰轮与前平衡板连接，可绕前平衡板转动，所述后惰轮与后摇摆板连接，可绕后摇摆板转动；所述丝杆通过丝杆固定座安装在前平衡板上，与机器人的前进方向垂直，所述丝杆电机安装在丝杆上，可沿丝杆往复移动，并通过改变前平衡板的重心来实现转弯操作；所述减速电机和电池组安装在前平衡板上，连接块安装在后摇摆板上，所述减速电机的输出轴与连接块固定，使前平衡板与后摇摆板建立连接，并在减速电机的驱动下摇摆前进；所述控制器安装在前平衡板上，分别与丝杆电机、减速电机、传感器组和电池组连接；所述传感器组包括用于监测机器人姿势的第一陀螺仪和第二陀螺仪、用于测量惰轮转向角度的第一转角传感器和第二转角传感器、以及用于测量惰轮速度的第一转速传感器和第二转速传感器；所述第一陀螺仪和第二陀螺仪分别安装在前平衡板和后摇摆板上；所述第一转角传感器和第二转角传感器分别安装在前平衡板与前惰轮的连接处和后摇摆板与后惰轮的连接处...

【专利技术属性】
技术研发人员：管贻生，曾昭恒，陈新，张宏，朱海飞，
申请(专利权)人：广东工业大学，
类型：新型
国别省市：广东,44