CN114800425B - Garbage container transfer robot and method - Google Patents
Garbage container transfer robot and method Download PDFInfo
- Publication number
- CN114800425B CN114800425B CN202210410192.8A CN202210410192A CN114800425B CN 114800425 B CN114800425 B CN 114800425B CN 202210410192 A CN202210410192 A CN 202210410192A CN 114800425 B CN114800425 B CN 114800425B
- Authority
- CN
- China
- Prior art keywords
- garbage container
- assembly
- body frame
- main body
- clamping
- 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
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
- B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/08—Gripping heads and other end effectors having finger members
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/0009—Constructional details, e.g. manipulator supports, bases
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02W—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO WASTEWATER TREATMENT OR WASTE MANAGEMENT
- Y02W30/00—Technologies for solid waste management
- Y02W30/10—Waste collection, transportation, transfer or storage, e.g. segregated refuse collecting, electric or hybrid propulsion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Specific Conveyance Elements (AREA)
Abstract
Description
技术领域technical field
本发明涉及自动化转运设备技术领域,特别是一种垃圾容器转运机器人及方法。The invention relates to the technical field of automatic transfer equipment, in particular to a garbage container transfer robot and method.
背景技术Background technique
大部分的居民区都会集中设置有垃圾收集站,每户产生的生活垃圾需要定点投放至垃圾收集站中,不可随意丢弃。当一户有1-2个常住人口的情况下,一天通常会产生1-2桶生活垃圾,为保持居住环境的干净卫生,避免滋生蚊蝇细菌,通常需要每日倒生活垃圾。Most of the residential areas will have centralized garbage collection stations, and the domestic garbage generated by each household needs to be thrown into the garbage collection station at a fixed point, and cannot be discarded at will. When a household has 1-2 permanent residents, 1-2 barrels of household garbage are usually produced a day. In order to keep the living environment clean and prevent the breeding of mosquitoes and bacteria, it is usually necessary to dump household garbage every day.
但当常住人口为腿脚不便的老人或残疾人或视障人士时,将生活垃圾提至垃圾收集站丢弃的过程就会存在一定的不便。因此,人们希望能研发一种可代替人工倒垃圾至指定地点的机器人,以解决上述特殊人群的困难,但遗憾的是,市面上未见此类机器人。However, when the resident population is the elderly or the disabled or visually impaired with inconvenient legs and feet, there will be some inconvenience in the process of bringing household garbage to the garbage collection station for disposal. Therefore, people hope to develop a robot that can replace manual dumping of garbage to a designated place to solve the difficulties of the above-mentioned special population, but unfortunately, there is no such robot on the market.
发明内容Contents of the invention
本发明的目的是克服现有技术的不足,而提供一种垃圾容器转运机器人及方法,它可代替人工倒垃圾至指定地点,清解决了居民区中特殊人群倒垃圾的不便。The purpose of the present invention is to overcome the deficiencies of the prior art, and provide a garbage container transfer robot and method, which can replace manual dumping of garbage to designated locations, and solve the inconvenience of dumping garbage for special groups of people in residential areas.
本发明的技术方案是:垃圾容器转运机器人,包括可移动机架、机械抓手总成和搬运总成;The technical solution of the present invention is: a garbage container transfer robot, including a movable frame, a mechanical gripper assembly and a handling assembly;
可移动机架包括主体车架、电动滚轮和升降驱动组件;主体车架前端设有平台,后端两侧设有对称布置的竖向支架,两个竖向支架之间形成载物区间,每个竖向支架上设有多根竖直布置的导向杆;多个电动滚轮对称安装在主体车架的下端两侧;两组升降驱动组件分别设在两个竖向支架上;The movable frame includes the main body frame, electric rollers and lifting drive components; the front end of the main body frame is provided with a platform, and the rear end is provided with symmetrically arranged vertical supports on both sides, and a loading area is formed between the two vertical supports. A plurality of vertically arranged guide rods are arranged on the first vertical bracket; a plurality of electric rollers are symmetrically installed on both sides of the lower end of the main vehicle frame; two sets of lifting drive components are respectively arranged on the two vertical brackets;
机械抓手总成包括云台电机、多自由度机械臂和机械爪;云台电机固定安装在平台中部上端,其上端设有水平转动面;多自由度机械臂下端固定安装在云台电机上,上端与机械爪连接;机械爪上设有开度可调的抓取口;The mechanical gripper assembly includes a pan-tilt motor, a multi-degree-of-freedom mechanical arm and a mechanical claw; the pan-tilt motor is fixedly installed at the upper end of the middle of the platform, and its upper end is provided with a horizontal rotating surface; the lower end of the multi-degree-of-freedom mechanical arm is fixedly installed on the pan-tilt motor, The upper end is connected with the mechanical claw; the mechanical claw is provided with a grab opening with adjustable opening;
搬运总成包括底座、往复推送组件、上座、低位托盘、高位托盘和夹爪机构;底座上端设有安装面,底座两侧边缘处固定安装有导向套和连接块;往复推送组件设在底座与上座之间,用于驱动上座做往复移动;上座连接在往复推送组件的上端;低位托盘固定安装底座上;高位托盘固定安装在上座上,并与低位托盘上下错位布置;夹爪机构包括水平推拉组件、翻转组件和夹爪,水平推拉组件设在上座上,并与翻转组件关联,以驱动翻转组件做往复直线移动,夹爪安装在翻转组件上,其被翻转组件带动做竖直平面内的转动,其上设有开度可调的夹持口;夹爪在往复推送组件、水平推拉组件、翻转组件的共同驱动下移动,以使夹持口的移动路径经过低位托盘的正上方区域及高位托盘的正上方区域;The handling assembly includes a base, a reciprocating push assembly, an upper seat, a low tray, a high tray, and a gripper mechanism; the upper end of the base is provided with a mounting surface, and guide sleeves and connecting blocks are fixedly installed on both sides of the base; the reciprocating push assembly is located between the base and Between the upper base, it is used to drive the upper base to reciprocate; the upper base is connected to the upper end of the reciprocating push component; the lower tray is fixedly installed on the base; the upper tray is fixedly installed on the upper base, and is arranged up and down with the lower tray; the jaw mechanism includes horizontal push-pull Components, overturning components and jaws, the horizontal push-pull component is set on the upper seat, and is associated with the overturning component to drive the overturning component to do reciprocating linear movement. Rotate, with a clamping mouth with adjustable opening; the jaws move under the joint drive of the reciprocating push component, the horizontal push-pull component, and the flipping component, so that the moving path of the clamping mouth passes through the area directly above the lower tray and The area directly above the high tray;
搬运总成通过底座两侧的导向套滑动安装在两个竖向支架的导向杆上,并位于载物区间中;搬运总成通过底座两侧的连接块与两组升降驱动组件关联,从而在两组升降驱动组件的共同驱动下,沿两个竖向支架的导向杆做竖直升降移动。The handling assembly is slidably installed on the guide rods of the two vertical supports through the guide sleeves on both sides of the base, and is located in the loading area; the handling assembly is associated with two sets of lifting drive components through the connecting blocks on both sides of the base, so that Driven jointly by two groups of lifting drive components, the vertical lifting movement is performed along the guide rods of the two vertical supports.
本发明进一步的技术方案是:升降驱动组件包括升降驱动组件包括电机A、主动轮、轮轴、从动轮和同步带;电机A固定安装在主体车架下端;主动轮固定安装在电机A的机轴上;轮轴水平布置并活动安装在竖向支架上端;从动轮固定安装在轮轴上,并位于主动轮的正上方;同步带绕设在主动轮与从动轮之间;相应的,搬运总成通过底座两侧的连接块与两组升降驱动组件的同步带固定连接。A further technical solution of the present invention is: the lifting drive assembly includes a lifting drive assembly including a motor A, a driving wheel, a wheel shaft, a driven wheel and a synchronous belt; the motor A is fixedly installed at the lower end of the main body frame; on the top; the wheel shaft is arranged horizontally and movably installed on the upper end of the vertical bracket; the driven wheel is fixedly installed on the wheel shaft and is located directly above the driving wheel; the synchronous belt is wound between the driving wheel and the driven wheel; correspondingly, the handling assembly passes through The connecting blocks on both sides of the base are fixedly connected with the synchronous belts of the two sets of lifting drive components.
本发明进一步的技术技术方案是:往复推送组件共有四组,呈矩形阵列分布在底座的安装面上;往复推送组件包括舵机A、连接座和摇臂;舵机A固定安装在底座上;连接座固定安装在上座下端;摇臂下端固定连接在舵机A的机轴上,上端与连接座铰接,摇臂在舵机A的驱动下做竖直平面内的摆动;四组往复推动组件同步动作,带动上座做竖直平面内弧形轨迹的往复摆动。The further technical solution of the present invention is: there are four groups of reciprocating push components, which are distributed in a rectangular array on the mounting surface of the base; the reciprocating push components include steering gear A, connecting seat and rocker arm; steering gear A is fixedly installed on the base; The connecting seat is fixedly installed on the lower end of the upper seat; the lower end of the rocker arm is fixedly connected to the shaft of the steering gear A, and the upper end is hinged with the connecting seat, and the rocker arm swings in the vertical plane driven by the steering gear A; four sets of reciprocating push components The synchronous action drives the upper base to do the reciprocating swing of the arc track in the vertical plane.
本发明进一步的技术方案是:水平推拉组件共有两组,分别对称布置在上座两侧;水平推拉组件包括气缸A、滑轨和滑块;气缸A固定安装在上座上,其活塞杆水平伸出;滑轨固定安装在上座上, 其延伸方向与气缸A的活塞杆的延伸方向一致;滑块滑动安装在滑轨上,其直接或间接与气缸A的活塞杆固定连接,其在气缸A的驱动下沿滑轨做直线往复移动。The further technical solution of the present invention is: there are two groups of horizontal push-pull components, which are arranged symmetrically on both sides of the upper seat; The slide rail is fixedly installed on the upper seat, and its extension direction is consistent with the extension direction of the piston rod of the cylinder A; the slide block is slidably installed on the slide rail, and it is directly or indirectly fixedly connected with the piston rod of the cylinder A Driven to make linear reciprocating movement along the slide rail.
本发明进一步的技术方案是:翻转组件包括承载板和双轴电机;承载板固定连接在两组水平推拉组件的两个滑块上端;双轴电机固定安装在承载板上,双轴电机的两根机轴分别从双轴电机的壳体两端水平伸出。The further technical solution of the present invention is: the turning assembly includes a bearing plate and a double-axis motor; the bearing plate is fixedly connected to the upper ends of the two sliders of two sets of horizontal push-pull components; The first machine shaft protrudes horizontally from both ends of the housing of the biaxial motor respectively.
本发明进一步的技术方案是:夹爪包括基座、夹臂、舵机B、橡胶夹盘及气缸B;基座前端可转动安装在双轴电机的机轴上,基座后端两侧设有滑槽,基座在双轴电机的驱动下做竖直平面内的摆动;两个夹臂相对布置并分别滑动安装在基座的两个滑槽内,并向基座后端外侧伸出;两个舵机B相对布置并分别固定安装在两个夹臂的末端,两个舵机B的机轴均水平伸出;两个橡胶夹盘相对布置并分别固定安装在两个舵机B的机轴上;气缸B设在两个夹臂之间,气缸B一端的活塞杆与一个夹臂固接,气缸B另一端的缸体与另一个夹臂固接,气缸B的活塞杆伸缩以驱动两个夹臂分别沿滑槽相向移动或背向移动,从而使夹持口扩大或缩小;相应的,所述夹持口为两个橡胶夹盘之间的区域。A further technical solution of the present invention is: the jaws include a base, a clamp arm, a steering gear B, a rubber chuck and a cylinder B; the front end of the base is rotatably mounted on the shaft of a biaxial motor, and With chute, the base swings in the vertical plane driven by the double-axis motor; the two clamping arms are arranged opposite to each other and are respectively slidably installed in the two chute slots of the base, and protrude to the outside of the rear end of the base ; The two steering gears B are arranged oppositely and fixedly mounted on the ends of the two clamp arms respectively, and the shafts of the two steering gears B extend out horizontally; the two rubber chucks are arranged oppositely and fixedly installed on the two steering gears B respectively. Cylinder B is located between the two clamp arms, the piston rod at one end of cylinder B is fixedly connected to one clamp arm, the cylinder body at the other end of cylinder B is fixed to the other clamp arm, and the piston rod of cylinder B is telescopic The two clamping arms are driven to move toward each other or backwards along the chute, so that the clamping opening is enlarged or reduced; correspondingly, the clamping opening is the area between the two rubber chucks.
本发明进一步的技术方案是:主体车架前端中部边沿处、后端中部边沿处、两侧边沿处分别设有照明模块。A further technical proposal of the present invention is that lighting modules are respectively provided at the edge of the middle part of the front end of the main body frame, the edge of the middle part of the rear end, and the edges of both sides.
本发明进一步的技术方案是:主体车架前端中部边沿处、后端中部边沿处、两侧边沿处分别设有摄像头。A further technical proposal of the present invention is that cameras are respectively provided at the edge of the middle part of the front end of the main body frame, at the edge of the middle part of the rear end, and at the edges of both sides.
本发明的技术方案是:一种垃圾容器转运方法,基于上述的垃圾容器转运机器人,执行垃圾容器转运操作之前,垃圾容器转运机器人处在初始状态,在初始状态下:The technical solution of the present invention is: a garbage container transfer method, based on the above-mentioned garbage container transfer robot, before performing the garbage container transfer operation, the garbage container transfer robot is in the initial state, in the initial state:
a、四组往复推动组件的摇臂摆动至一端的极限位置,以使搬运总成处在两个竖向支架之间的载物区间中,以提高垃圾容器转运机器人的通过性;a. The rocker arms of the four sets of reciprocating push components swing to the limit position at one end, so that the handling assembly is in the loading area between the two vertical supports, so as to improve the passability of the garbage container transfer robot;
b、两组升降驱动组件的同步带带动搬运总成向下移动至极限位置,以使垃圾容器转运机器人的重心高度降低;b. The synchronous belts of the two sets of lifting drive components drive the handling assembly to move down to the limit position, so that the height of the center of gravity of the garbage container transfer robot is reduced;
c、水平推拉组件的气缸A的活塞杆处于缩回状态,夹爪在翻转组件的双轴电机的驱动下转动至朝向主体车架前端,从而使搬运总成不超出主体车架后端,并相对靠近主体车架中部,以提升垃圾容器转运机器人在空载时的稳定性;c. The piston rod of the cylinder A of the horizontal push-pull assembly is in the retracted state, and the jaws are driven by the biaxial motor of the flip assembly to rotate towards the front end of the main frame, so that the handling assembly does not exceed the rear end of the main frame, and Relatively close to the middle of the main body frame to improve the stability of the garbage container transfer robot when it is empty;
d、夹爪的气缸B活塞杆伸出,以使两个夹臂背向移动至极限位置,从而将夹持口扩至最大,以做好夹持垃圾容器的准备;d. The piston rod of the cylinder B of the jaws is stretched out, so that the two clamp arms move back to the limit position, thereby expanding the clamping opening to the maximum, so as to prepare for clamping the garbage container;
e、多自由度机械臂通过折叠以降低高度,并调整其不超出平台的正上方区域,以提高垃圾容器转运机器人的通过性并降低垃圾容器转运机器人的重心高度;e. The multi-degree-of-freedom mechanical arm is folded to reduce the height, and is adjusted not to exceed the area directly above the platform, so as to improve the passability of the garbage container transfer robot and reduce the height of the center of gravity of the garbage container transfer robot;
垃圾容器转运方法如下:The garbage container transfer method is as follows:
S01,夹紧第一个垃圾容器:S01, clamp the first waste container:
a、控制电动滚轮转动以调整垃圾容器转运机器人的位姿,使主体车架后端正对待拾取的垃圾容器;a. Control the rotation of the electric roller to adjust the posture of the garbage container transfer robot, so that the rear end of the main frame is facing the picked up garbage container;
b、不分先后次序执行以下几项操作:b. Perform the following operations in no particular order:
1、两组水平推拉组件的气缸A的活塞杆同步伸出,推动翻转组件和夹爪向主体车架后端移动;1. The piston rods of the cylinder A of the two sets of horizontal push-pull components extend out synchronously, pushing the flip component and the jaws to move to the rear end of the main body frame;
2、翻转组件的双轴电机启动,驱动夹爪向主体车架后端翻转;2. The double-axis motor of the overturning component is started, and the gripper is driven to overturn towards the rear end of the main body frame;
3、四组往复推送组件的舵机A同步启动,驱动四条摇臂同步向主体车架后端摆动,使上座、夹爪机构和高位托盘一同向主体车架后端移动;3. The steering gear A of the four sets of reciprocating push components starts synchronously, driving the four rocker arms to swing synchronously to the rear end of the main body frame, so that the upper seat, the gripper mechanism and the high tray move to the rear end of the main body frame together;
4、控制两组升降控制组件的电机A启动,驱动两条同步带同步运转,进而通过同步带与底座两侧连接块的固连关系,带动搬运总成做竖直方向移动,将夹爪高度调节至与第一个垃圾容器的高度相适应;4. The motor A that controls the two sets of lifting control components starts, drives the two synchronous belts to run synchronously, and then drives the handling assembly to move vertically through the fixed connection between the synchronous belt and the connecting blocks on both sides of the base, and the height of the jaws Adjust to match the height of the first waste container;
上述四项操作完成后,使夹爪从主体车架的后端伸出,夹爪的夹持口正对并包容第一个垃圾容器;After the above four operations are completed, make the jaws protrude from the rear end of the main body frame, and the clamping mouth of the jaws is facing and containing the first garbage container;
c、夹爪的气缸B活塞杆缩回,以使两个夹臂相向移动至夹紧第一个垃圾容器的外壁两侧;c. The cylinder B piston rod of the jaw retracts, so that the two jaw arms move toward each other to clamp the two sides of the outer wall of the first garbage container;
S02,将第一个垃圾容器转移至高位托盘上:S02, transfer the first garbage container to the high tray:
a、翻转组件的双轴电机启动,驱动夹爪向主体车架前端翻转;与此同时,两个舵机B同步启动,带动两个橡胶夹盘和第一个垃圾容器转动,使第一个垃圾容器在翻转的过程中始终保持竖直不倾斜;翻转到位后,第一个垃圾容器处在高位托盘的正上方,并紧邻高位托盘;a. The double-axis motor of the overturning component is started, and the driving jaws are turned over to the front end of the main body frame; at the same time, the two steering gears B are started synchronously, driving the two rubber chucks and the first garbage container to rotate, so that the first The garbage container is always kept vertical and not tilted during the turning process; after the turning is in place, the first garbage container is directly above the high-level tray and is next to the high-level tray;
b、夹爪的气缸B活塞杆伸出,使两个夹臂背向移动至极限位置,从而松开第一个垃圾容器的外壁两侧,第一个垃圾容器即落在高位托盘上;b. The piston rod of the cylinder B of the jaws is stretched out, so that the two clamp arms move back to the limit position, thereby loosening the two sides of the outer wall of the first garbage container, and the first garbage container falls on the high tray;
本步骤中,对双轴电机与舵机B的协调控制基于角度倾斜传感器的实时检测数据;In this step, the coordinated control of the biaxial motor and steering gear B is based on the real-time detection data of the angle and tilt sensor;
S03,夹紧第二个垃圾容器:S03, clamp the second waste container:
a、控制电动滚轮转动以调整垃圾容器转运机器人的位姿,使主体车架后端正对第二个垃圾容器;a. Control the rotation of the electric roller to adjust the posture of the garbage container transfer robot, so that the rear end of the main frame is facing the second garbage container;
b、不分先后次序执行以下几项操作:b. Perform the following operations in no particular order:
1、翻转组件的双轴电机启动,驱动夹爪向主体车架后端翻转;1. The double-axis motor of the overturning component is started, and the gripper is driven to overturn towards the rear end of the main body frame;
2、两组升降控制组件的电机A启动,驱动两条同步带同步运转,进而通过同步带与底座两侧连接块的固连关系,带动搬运总成做竖直方向移动,将夹爪高度调节至与第二个垃圾容器的高度相适应;2. The motor A of the two sets of lifting control components starts to drive the two synchronous belts to run synchronously, and then through the fixed connection between the synchronous belt and the connecting blocks on both sides of the base, it drives the handling assembly to move vertically and adjusts the height of the jaws. to adapt to the height of the second waste container;
上述两项操作完成后,夹爪从主体车架的后端伸出,夹爪的夹持口正对并包容第二个垃圾容器;After the above two operations are completed, the jaws protrude from the rear end of the main body frame, and the clamping mouth of the jaws faces and accommodates the second garbage container;
c、夹爪的气缸B活塞杆缩回,以使两个夹臂相向移动至夹紧第二个垃圾容器的外壁两侧;c. The cylinder B piston rod of the jaw retracts, so that the two jaw arms move toward each other to clamp the two sides of the outer wall of the second garbage container;
S04,将第二个垃圾容器转移至低位托盘上:S04, transfer the second waste container to the lower tray:
a、同时执行以下几项操作:a. Perform the following operations at the same time:
1、两组水平推拉组件的气缸A的活塞杆同步缩回,推动翻转组件和夹爪向主体车架前端移动;1. The piston rods of the cylinder A of the two sets of horizontal push-pull components are retracted synchronously, pushing the flip component and the jaws to move to the front end of the main body frame;
2、四组往复推送组件的舵机A同步启动,驱动四条摇臂同步向主体车架前端摆动,使上座和夹爪机构一同向主体车架前端移动;2. The steering gear A of the four sets of reciprocating push components starts synchronously, driving the four rocker arms to swing synchronously to the front end of the main body frame, so that the upper seat and the gripper mechanism move to the front end of the main body frame together;
上述两项操作完成时,第二个垃圾容器处在低位托盘的正上方,并紧邻低位托盘,并且,搬运总成整体处在载物区间内;When the above two operations are completed, the second garbage container is directly above the low-level tray and adjacent to the low-level tray, and the entire handling assembly is in the loading area;
b、夹爪的气缸B活塞杆伸出,使两个夹臂背向移动至极限位置,从而松开第二个垃圾容器的外壁两侧,第二个垃圾容器即落在低位托盘上;b. The piston rod of the cylinder B of the jaws is stretched out, so that the two clamp arms move back to the limit position, thereby loosening the two sides of the outer wall of the second garbage container, and the second garbage container falls on the low tray;
c、两组升降控制组件的电机A启动,驱动两条同步带同步运转,进而通过同步带与底座两侧连接块的固连关系,带动搬运总成下降至其移动行程的最下端,从而做好转运准备;c. The motor A of the two sets of lifting control components is started to drive the two synchronous belts to run synchronously, and then through the fixed connection between the synchronous belt and the connecting blocks on both sides of the base, the handling assembly is driven down to the bottom end of its moving stroke, thereby making Good transshipment preparation;
S05,转运垃圾容器:S05, Transfer garbage container:
基于摄像头的提供的视觉支持,控制电动滚轮动作,将垃圾容器转运机器人移动至卸载垃圾的指定地点;Based on the visual support provided by the camera, the movement of the electric roller is controlled to move the garbage container transfer robot to the designated location for unloading garbage;
S06,夹取第二个垃圾容器:S06, grabbing the second garbage container:
a、两组升降控制组件的电机A启动,驱动两条同步带同步运转,进而通过同步带与底座两侧连接块的固连关系,带动低位托盘上升至高于卸载平面;a. The motor A of the two sets of lifting control components is started to drive the two synchronous belts to run synchronously, and then through the fixed connection between the synchronous belt and the connecting blocks on both sides of the base, the lower tray is driven to rise above the unloading plane;
b、翻转组件的双轴电机启动,驱动夹爪向下转动一定角度,使夹爪的夹持口将第二个垃圾容器包容在内;b. The double-axis motor of the overturning component is started, and the driving jaws are rotated downward at a certain angle, so that the gripping opening of the jaws contains the second garbage container;
c、夹爪的气缸B活塞杆伸出,使两个夹臂相向移动,直至夹紧第二个垃圾容器的外壁;c. The piston rod of the cylinder B of the jaws is stretched out, so that the two clamp arms move toward each other until the outer wall of the second garbage container is clamped;
S07,将第二个垃圾容器转移至卸载平面上:S07, transfer the second garbage container to the unloading plane:
a、同时执行以下几项操作:a. Perform the following operations at the same time:
1、翻转组件的双轴电机启动,驱动夹爪向上转动一定角度,与此同时,两个舵机B同步启动,带动两个橡胶夹盘和第二个垃圾容器转动,使第二个垃圾容器在向上转动的过程中始终保持竖直不倾斜;1. The double-axis motor of the overturning component starts, and the driving jaws rotate upwards at a certain angle. At the same time, the two servos B start synchronously, driving the two rubber chucks and the second garbage container to rotate, so that the second garbage container Keep it vertical and not tilted during the upward rotation;
2、四组往复推送组件的舵机A同步启动,驱动四条摇臂同步向主体车架后端摆动,使搬运总成向主体车架后端移动;2. The steering gear A of the four sets of reciprocating push components starts synchronously, and drives the four rocker arms to swing synchronously to the rear end of the main frame, so that the handling assembly moves to the rear end of the main frame;
3、两组水平推拉组件的气缸A的活塞杆同步伸出,推动翻转组件、夹爪和第二个垃圾容器向主体车架后端移动;3. The piston rods of the cylinder A of the two sets of horizontal push-pull components extend out synchronously, pushing the flip component, the gripper and the second garbage container to move to the rear end of the main body frame;
上述三项操作完成时,第二个垃圾容器伸出在主体车架后端外部;When the above three operations were completed, the second garbage container stretched out outside the rear end of the main vehicle frame;
b、翻转组件的双轴电机启动,驱动夹爪向下转动一定角度,与此同时,两个舵机B同步启动,带动两个橡胶夹盘和被第二个垃圾容器转动,使第二个垃圾容器在向下转动的过程中始终保持竖直不倾斜;从而使第二个垃圾容器的高度降低并贴近卸载平面;b. The double-axis motor of the overturning component is started, and the driving jaws are turned downward for a certain angle. At the same time, the two steering gears B are started synchronously, driving the two rubber chucks and being rotated by the second garbage container, so that the second garbage container The garbage container is always kept vertical and not tilted during the downward rotation; thus the height of the second garbage container is lowered and close to the unloading plane;
c、夹爪的气缸B活塞杆伸出,使两个夹臂背向移动至极限位置,从而松开第二个垃圾容器的外壁两侧,第二个垃圾容器即落在卸载平面上;c. The piston rod of cylinder B of the jaws is stretched out, so that the two clamp arms move back to the limit position, thereby loosening the two sides of the outer wall of the second garbage container, and the second garbage container falls on the unloading plane;
本步骤中,对双轴电机与舵机B的协调控制基于角度倾斜传感器的实时检测数据;In this step, the coordinated control of the biaxial motor and steering gear B is based on the real-time detection data of the angle and tilt sensor;
S08,夹取第一个垃圾容器:S08, grab the first garbage container:
a、翻转组件的双轴电机启动,驱动夹爪向主体车架前端翻转;以此同时,两组水平推拉组件的气缸A的活塞杆同步缩回,推动翻转组件和夹爪向主体车架前端移动;通过上述两项操作,使夹爪的夹持口正对并包容第一个垃圾容器;a. The double-axis motor of the overturning component is started, and the jaws are driven to overturn towards the front end of the main frame; at the same time, the piston rods of the cylinder A of the two sets of horizontal push-pull components are retracted synchronously, pushing the overturning component and the jaws towards the front end of the main frame Move; through the above two operations, make the clamping mouth of the jaws face and contain the first garbage container;
b、夹爪的气缸B活塞杆缩回,以使两个夹臂相向移动至夹紧第一个垃圾容器的外壁两侧;b. The cylinder B piston rod of the gripper retracts, so that the two gripper arms move toward each other to clamp the two sides of the outer wall of the first garbage container;
S09,将第一个垃圾容器转移至卸载平面上:S09, transfer the first garbage container to the unloading plane:
a、同时执行以下几项操作:a. Perform the following operations at the same time:
1、翻转组件的双轴电机启动,驱动夹爪向主体车架后端翻转;与此同时,两个舵机B同步启动,带动两个橡胶夹盘和第一个垃圾容器转动,使第一个垃圾容器在翻转的过程中始终保持竖直不倾斜;1. The double-axis motor of the overturning component is started, and the jaws are driven to turn over to the rear end of the main body frame; at the same time, the two steering gears B are started synchronously, driving the two rubber chucks and the first garbage container to rotate, so that the first A garbage container is always kept vertical and not tilted during the turning process;
2、两组两组水平推拉组件的气缸A的活塞杆同步伸出,推动翻转组件、夹爪和第一个垃圾容器向主体车架后端移动;2. The piston rods of the cylinders A of the two groups of horizontal push-pull components extend out synchronously, pushing the flip component, the gripper and the first garbage container to move to the rear end of the main body frame;
上述两项操作完成后,第一个垃圾容器伸出在主体车架后端外部;After the above two operations are completed, the first garbage container protrudes outside the rear end of the main body frame;
c、翻转组件的双轴电机启动,驱动夹爪向下转动一定角度,与此同时,两个舵机B同步启动,带动两个橡胶夹盘和第一个垃圾容器转动,使第二个垃圾容器在向下转动的过程中始终保持竖直不倾斜;从而使第一个垃圾容器的高度降低并贴近卸载平面;c. The double-axis motor of the overturning component is started, and the driving jaws are turned downward for a certain angle. At the same time, the two steering gears B are started synchronously, driving the two rubber chucks and the first garbage container to rotate, so that the second garbage container The container is always kept vertical and not tilted during the downward rotation; thus the height of the first garbage container is lowered and close to the unloading plane;
d、夹爪的气缸B活塞杆伸出,使两个夹臂背向移动至极限位置,从而松开第一个垃圾容器的外壁两侧,第一个垃圾容器即落在卸载平面上;d. The piston rod of cylinder B of the jaws is stretched out, so that the two clamp arms move back to the limit position, thereby loosening the two sides of the outer wall of the first garbage container, and the first garbage container falls on the unloading plane;
本步骤中,对双轴电机与舵机B的协调控制基于角度倾斜传感器的实时检测数据;In this step, the coordinated control of the biaxial motor and steering gear B is based on the real-time detection data of the angle and tilt sensor;
S10,机构复位:S10, mechanism reset:
a、四组往复推动组件的摇臂向主体车架前端摆动至极限位置;a. The rocker arms of the four sets of reciprocating push components swing to the front end of the main body frame to the limit position;
b、两组升降驱动组件的同步带带动搬运总成向下移动至极限位置;b. The synchronous belts of the two sets of lifting drive components drive the handling assembly down to the limit position;
c、两组水平推拉组件的气缸A的活塞杆缩回,使夹爪和翻转组件向主体车架11前端移动;c. The piston rods of the cylinder A of the two sets of horizontal push-pull assemblies are retracted, so that the jaws and the turning assembly move to the front end of the main body frame 11;
d、翻转组件的双轴电机启动,驱动夹爪转动至朝向主体车架前端;d. The double-axis motor of the overturning component is started, and the driving jaws are rotated towards the front end of the main body frame;
上述四项操作同时执行,上述四项操作完成时,搬运总成回到两个竖向支架之间的载物区间中,并处在其移动行程的最低位置;The above four operations are carried out at the same time. When the above four operations are completed, the handling assembly returns to the loading area between the two vertical supports and is at the lowest position of its moving stroke;
S11,投放垃圾:S11, throwing out garbage:
基于摄像头的提供的视觉支持,一方面控制电动滚轮动作以调整垃圾容器转运机器人的位姿,另一方面控制机械抓手总成动作,从而依次夹取两个垃圾容器中的垃圾袋,投放至指定的垃圾桶中。Based on the visual support provided by the camera, on the one hand, the action of the electric roller is controlled to adjust the posture of the garbage container transfer robot; in the designated trash can.
本发明与现有技术相比具有如下优点:Compared with the prior art, the present invention has the following advantages:
1、其应用于居民小区,可代替人工倒垃圾至指定地点,清解决了居民小区中特殊人群倒垃圾的不便。在转运垃圾容器的过程中,实现了包含拾取-转运-卸载的全流程自动化操作。1. It is used in residential quarters, and can replace manual dumping of garbage to designated locations, and solves the inconvenience of dumping garbage for special groups of people in residential quarters. In the process of transferring garbage containers, the whole process of automatic operation including picking-transfer-unloading is realized.
2、其转运的目标是垃圾容器,并不是装有垃圾的垃圾袋,转运过程中可靠性较好,垃圾不会散落或掉落,避免了其被撒落出来的的细碎垃圾或液体弄脏。2. The target of its transfer is the garbage container, not the garbage bag containing the garbage. The reliability is better during the transfer process, and the garbage will not be scattered or dropped, avoiding its being soiled by the scattered fine garbage or liquid .
3、其搭载的机械抓手总成可用于转运过程中按电梯按扭、转运到达指定地点后拎出垃圾袋、夹取垃圾袋投入指定垃圾箱等操作,进一步提升了其自动化程度。3. The mechanical gripper assembly it carries can be used for operations such as pressing the elevator button during the transfer process, picking out the garbage bag after the transfer arrives at the designated location, and picking up the garbage bag and putting it into the designated garbage bin, which further improves its automation.
4、搬运总成上搭载了高位托盘和低位托盘,可一次性运载两个垃圾容器至指定地点,转运效率较高,高位托盘和低位托盘在高度方向上错位布置,以避免放置垃圾桶时相互碰撞干涉,可靠性较好。4. The handling assembly is equipped with a high-position tray and a low-position tray, which can carry two garbage containers to the designated place at one time, and the transfer efficiency is high. The high-position tray and the low-position tray are misplaced in the height direction to avoid mutual interference when placing the trash cans. Collision interference, good reliability.
5、搬运总成共可实现5个自由度的运动(包括升降驱动组件提供的竖直升降移动、往复推送组件提供的竖直平面内的往复摆动、水平推拉组件提供的水平面内的往复直线移动、翻转组件提供的竖直平面内的转动、舵机B提供的竖直平面内的转动),机动灵活,可抓取放置在一定高度范围内的台阶上的垃圾桶,或将垃圾桶卸载在一定高度范围内的台阶上,可操作性较强。5. The handling assembly can realize a total of 5 degrees of freedom of movement (including the vertical lifting movement provided by the lifting drive component, the reciprocating swing in the vertical plane provided by the reciprocating push component, and the reciprocating linear movement in the horizontal plane provided by the horizontal push-pull component , the rotation in the vertical plane provided by the overturning component, the rotation in the vertical plane provided by the steering gear B), flexible and maneuverable, it can grab the trash can placed on the steps within a certain height range, or unload the trash can on the On the steps within a certain height range, the maneuverability is strong.
以下结合图和实施例对本发明作进一步描述。Below in conjunction with figure and embodiment the present invention will be further described.
附图说明Description of drawings
图1为本发明的结构示意图;Fig. 1 is a structural representation of the present invention;
图2为搬运总成在一种视角下的结构示意图;Fig. 2 is a structural schematic view of the handling assembly in a perspective;
图3为搬运总成在另一视角下的结构示意图;Fig. 3 is a structural schematic diagram of the handling assembly from another perspective;
图4为可移动机架的结构示意图;Fig. 4 is the structural representation of movable frame;
图5为垃圾容器转运方法S01步骤的状态图;Fig. 5 is the state diagram of step S01 of garbage container transshipment method;
图6为垃圾容器转运方法S02步骤的状态图;Fig. 6 is a state diagram of step S02 of the garbage container transshipment method;
图7为垃圾容器转运方法S03步骤的状态图;Fig. 7 is a state diagram of step S03 of the garbage container transshipment method;
图8为垃圾容器运转方法S04步骤a分步骤的状态图;Fig. 8 is a sub-step state diagram of step a of the garbage container operating method S04;
图9为垃圾容器运转方法S04步骤c分步骤的状态图;Fig. 9 is a state diagram of step c sub-steps of the garbage container operation method S04;
图10为垃圾容器运转方法S11步骤的状态图。Fig. 10 is a state diagram of step S11 of the garbage container operation method.
图例说明:主体车架11;平台111;竖向支架112;导向杆1121;载物区间113;照明模块114;电动滚轮12;电机A131;主动轮132;轮轴133;从动轮134;同步带135;云台电机21;多自由度机械臂22;机械爪23;抓取口231;底座31;导向套311;连接块312;舵机A321;连接座322;摇臂323;上座33;低位托盘34;高位托盘35;气缸A361;滑轨362;滑块363;承载板364;双轴电机365;基座366;滑槽3661;夹臂367;舵机B368;橡胶夹盘369;气缸B360。Legend: main body frame 11;
具体实施方式Detailed ways
实施例1:Example 1:
如图1-4所示,垃圾容器转运机器人,包括可移动机架、机械抓手总成和搬运总成。As shown in Figure 1-4, the garbage container transfer robot includes a movable frame, a mechanical gripper assembly and a handling assembly.
可移动机架包括主体车架11、电动滚轮12和升降驱动组件。主体车架11前端设有平台111,后端两侧设有对称布置的竖向支架112,两个竖向支架112之间形成载物区间113,每个竖向支架112上设有多根竖直布置的导向杆1121。多个电动滚轮12对称安装在主体车架11的下端两侧。两组升降驱动组件分别设在两个竖向支架112上。升降驱动组件包括电机A131、主动轮132、轮轴133、从动轮134和同步带135。电机A131固定安装在主体车架11下端。主动轮132固定安装在电机A131的机轴上。轮轴133水平布置并活动安装在竖向支架112上端。从动轮134固定安装在轮轴133上,并位于主动轮132的正上方。同步带135绕设在主动轮132与从动轮134之间。The movable frame includes a main vehicle frame 11,
机械抓手总成包括云台电机21、多自由度机械臂22和机械爪23。云台电机21固定安装在平台111中部上端,其上端设有水平转动面。多自由度机械臂22下端固定安装在云台电机21上,上端与机械爪23连接。机械爪23上设有开度可调的抓取口231。多自由度机械臂22和机械爪23的结构均为现有技术,此处不再赘述。The mechanical gripper assembly includes a pan-tilt motor 21 , a multi-degree-of-freedom
搬运总成包括底座31、往复推送组件、上座33、低位托盘34、高位托盘35和夹爪机构。The handling assembly includes a
底座31上端设有安装面,底座31两侧边缘处固定安装有导向套311和连接块312。The upper end of the
往复推送组件设在底座31与上座33之间,用于驱动上座33做往复移动。往复推送组件共有四组,呈矩形阵列分布在底座31的安装面上。往复推送组件包括舵机A321、连接座322和摇臂323。舵机A321固定安装在底座31上。连接座323固定安装在上座33下端。摇臂323下端固定连接在舵机A321的机轴上,上端与连接座323铰接,摇臂323在舵机A321的驱动下做竖直平面内的摆动。四组往复推动组件同步动作,带动上座33做竖直平面往复摆动。The reciprocating push assembly is arranged between the base 31 and the
上座33固定连接在四组往复推送组件的连接座322上端。低位托盘34固定安装底座31上。高位托盘35固定安装在上座33上,并与低位托盘34上下错开布置。The
夹爪机构包括水平推拉组件、翻转组件和夹爪。水平推拉组件共有两组,分别对称布置在上座33两侧。水平推拉组件包括气缸A361、滑轨362和滑块363。气缸A361固定安装在上座33上,其活塞杆水平伸出。滑轨362固定安装在上座33上, 其延伸方向与气缸A361的活塞杆的延伸方向一致。滑块363滑动安装在滑轨362上,其直接或间接与气缸A361的活塞杆固定连接,其在气缸A361的驱动下沿滑轨362做直线往复移动。翻转组件包括承载板364和双轴电机365。承载板364固定连接在两组水平推拉组件的两个滑块363上端。双轴电机365固定安装在承载板364上,双轴电机365的两根机轴分别从双轴电机365的壳体两端水平伸出。夹爪包括基座366、夹臂367、舵机B368、橡胶夹盘369及气缸B360。基座366前端可转动安装在双轴电机365的机轴上,基座366后端两侧设有滑槽3661,基座366在双轴电机365的驱动下做竖直平面内的摆动。两个夹臂367相对布置并分别滑动安装在基座366的两个滑槽3661内,并向基座366后端外侧伸出。两个舵机B368相对布置并分别固定安装在两个夹臂367的末端,两个舵机B368的机轴均水平伸出。两个橡胶夹盘369相对布置并分别固定安装在两个舵机B368的机轴上,两个橡胶夹盘369之间的区域为夹持口。气缸B360设在两个夹臂367之间,气缸B360一端的活塞杆与一个夹臂367固接,气缸B360另一端的缸体与另一个夹臂367固接,气缸B360的活塞杆伸缩以驱动两个夹臂367分别沿滑槽3661相向移动或背向移动,从而使夹持口扩大或缩小。夹爪在往复推送组件、水平推拉组件、翻转组件的共同驱动下移动,以使夹持口的移动路径可经过低位托盘34的正上方区域及高位托盘35的正上方区域。The jaw mechanism includes a horizontal push-pull assembly, a flip assembly and jaws. There are two groups of horizontal push-pull assemblies, which are symmetrically arranged on both sides of the
搬运总成通过底座31两侧的导向套311滑动安装在两个竖向支架112的导向杆1121上,并位于载物区间113中。搬运总成通过底座31两侧的连接块312与两组升降驱动组件的同步带135固定连接,从而在两组升降驱动组件的共同驱动下,沿两个竖向支架112的导向杆1121做竖直升降移动。The transport assembly is slidably installed on the
优选,主体车架11前端中部边沿处、后端中部边沿处、两侧边沿处分别设有照明模块114。Preferably,
优选,主体车架11前端中部边沿处、后端中部边沿处、两侧边沿处分别设有摄像头(图中未示出)。Preferably, cameras (not shown in the figure) are respectively provided at the edge of the middle part of the front end, the edge of the middle part of the rear end, and the edges of both sides of the main body frame 11 .
优选,垃圾容器转运机器人还包括供电模块(图中未示出)。供电模块安装在平台111上,并与垃圾容器转运机器人中的需电部件电连接,从而为各需电部件的运行提供电力支持。Preferably, the garbage container transfer robot further includes a power supply module (not shown in the figure). The power supply module is installed on the
本发明提供的垃圾容器转运机器人可应用于居民小区,实现住户的垃圾容器拾取、转运和卸载。在转运垃圾容器的过程中,机械抓手总成的机械爪可用于按电梯按扭,垃圾容器转运机器人移动路径应避免台阶,选择无障碍通道行进。The garbage container transfer robot provided by the present invention can be applied to residential quarters to realize the picking, transfer and unloading of household garbage containers. During the process of transferring garbage containers, the mechanical claws of the mechanical gripper assembly can be used to press the elevator buttons, and the moving path of the garbage container transfer robot should avoid steps and choose barrier-free passages.
如图5-10所示,一种垃圾容器转运方法,基于上述的垃圾容器转运机器人,执行垃圾容器转运操作之前,垃圾容器转运机器人处在初始状态,在初始状态下:As shown in Figure 5-10, a garbage container transfer method is based on the above-mentioned garbage container transfer robot. Before performing the garbage container transfer operation, the garbage container transfer robot is in the initial state. In the initial state:
a、四组往复推动组件的摇臂323摆动至一端的极限位置,以使搬运总成处在两个竖向支架112之间的载物区间113中,以提高垃圾容器转运机器人的通过性;a. The
b、两组升降驱动组件的同步带135带动搬运总成向下移动至极限位置,以使垃圾容器转运机器人的重心高度降低;b. The
c、水平推拉组件的气缸A361的活塞杆处于缩回状态,夹爪在翻转组件的双轴电机365的驱动下转动至朝向主体车架11前端,从而使搬运总成不超出主体车架11后端,并相对靠近主体车架11中部,以提升垃圾容器转运机器人在空载时的稳定性;c. The piston rod of the cylinder A361 of the horizontal push-pull assembly is in the retracted state, and the jaws are driven by the
d、夹爪的气缸B360活塞杆伸出,以使两个夹臂367背向移动至极限位置,从而将夹持口扩至最大,以做好夹持垃圾容器的准备;d. The piston rod of the cylinder B360 of the jaws is stretched out, so that the two
e、多自由度机械臂22通过折叠以降低高度,并调整其不超出平台111的正上方区域,以提高垃圾容器转运机器人的通过性并降低垃圾容器转运机器人的重心高度。e. The multi-degree-of-
垃圾容器转运方法如下:The garbage container transfer method is as follows:
S01,夹紧第一个垃圾容器:S01, clamp the first waste container:
a、控制电动滚轮12转动以调整垃圾容器转运机器人的位姿,使主体车架11后端正对待拾取的垃圾容器;a. Control the rotation of the
b、不分先后次序执行以下几项操作:b. Perform the following operations in no particular order:
1、两组水平推拉组件的气缸A361的活塞杆同步伸出,推动翻转组件和夹爪向主体车架11后端移动;1. The piston rods of the cylinders A361 of the two sets of horizontal push-pull assemblies are extended synchronously, pushing the turning assembly and the jaws to move to the rear end of the main body frame 11;
2、翻转组件的双轴电机365启动,驱动夹爪向主体车架11后端翻转;2. The
3、四组往复推送组件的舵机A321同步启动,驱动四条摇臂323同步向主体车架11后端摆动,使上座33、夹爪机构和高位托盘35一同向主体车架11后端移动;3. The servos A321 of the four groups of reciprocating push components are started synchronously, and the four
4、控制两组升降控制组件的电机A131启动,驱动两条同步带135同步运转,进而通过同步带135与底座31两侧连接块312的固连关系,带动搬运总成做竖直方向移动,将夹爪高度调节至与第一个垃圾容器的高度相适应;4. The motor A131 that controls the two sets of lifting control components starts to drive the two
上述四项操作完成后,使夹爪从主体车架11的后端伸出,夹爪的夹持口正对并包容第一个垃圾容器;After the above four operations are completed, the jaws are extended from the rear end of the main body frame 11, and the clamping mouth of the jaws is facing and containing the first garbage container;
c、夹爪的气缸B360活塞杆缩回,以使两个夹臂367相向移动至夹紧第一个垃圾容器的外壁两侧。c. The piston rod of the cylinder B360 of the clamping claw is retracted, so that the two clamping
S02,将第一个垃圾容器转移至高位托盘上:S02, transfer the first garbage container to the high tray:
a、翻转组件的双轴电机365启动,驱动夹爪向主体车架11前端翻转;与此同时,两个舵机B368同步启动,带动两个橡胶夹盘369和第一个垃圾容器转动,使第一个垃圾容器在翻转的过程中始终保持竖直不倾斜;翻转到位后,第一个垃圾容器处在高位托盘35的正上方,并紧邻高位托盘35;a. The
b、夹爪的气缸B360活塞杆伸出,使两个夹臂367背向移动至极限位置,从而松开第一个垃圾容器的外壁两侧,第一个垃圾容器随即落在高位托盘35上;b. The piston rod of the cylinder B360 of the jaws is stretched out, so that the two
本步骤中,对双轴电机365与舵机B368的协调控制基于角度倾斜传感器的实时检测数据。In this step, the coordinated control of the
S03,夹紧第二个垃圾容器:S03, clamp the second waste container:
a、控制电动滚轮12转动以调整垃圾容器转运机器人的位姿,使主体车架11后端正对第二个垃圾容器;a. Control the rotation of the
b、不分先后次序执行以下几项操作:b. Perform the following operations in no particular order:
1、翻转组件的双轴电机365启动,驱动夹爪向主体车架11后端翻转;1. The
2、两组升降控制组件的电机A131启动,驱动两条同步带135同步运转,进而通过同步带135与底座31两侧连接块312的固连关系,带动搬运总成做竖直方向移动,将夹爪高度调节至与第二个垃圾容器的高度相适应;2. The motors A131 of the two sets of lifting control components start to drive the two
上述两项操作完成后,夹爪从主体车架11的后端伸出,夹爪的夹持口正对并包容第二个垃圾容器;After the above two operations are completed, the jaws protrude from the rear end of the main body frame 11, and the clamping mouth of the jaws faces and accommodates the second garbage container;
c、夹爪的气缸B360活塞杆缩回,以使两个夹臂367相向移动至夹紧第二个垃圾容器的外壁两侧。c. The piston rod of the cylinder B360 of the clamping claw is retracted, so that the two clamping
S04,将第二个垃圾容器转移至低位托盘上:S04, transfer the second waste container to the lower tray:
a、同时执行以下几项操作:a. Perform the following operations at the same time:
1、两组水平推拉组件的气缸A361的活塞杆同步缩回,推动翻转组件和夹爪向主体车架前端移动;1. The piston rods of the cylinder A361 of the two sets of horizontal push-pull components are retracted synchronously, pushing the flip component and the jaws to move to the front end of the main body frame;
2、四组往复推送组件的舵机A321同步启动,驱动四条摇臂323同步向主体车架11前端摆动,使上座33和夹爪机构一同向主体车架11前端移动;2. The servos A321 of the four groups of reciprocating push components are synchronously started, and the four
上述两项操作完成时,第二个垃圾容器处在低位托盘34的正上方,并紧邻低位托盘34,并且,搬运总成整体处在载物区间113内;When the above two operations are completed, the second garbage container is located directly above the
b、夹爪的气缸B360活塞杆伸出,使两个夹臂367背向移动至极限位置,从而松开第二个垃圾容器的外壁两侧,第二个垃圾容器即落在低位托盘34上;b. The piston rod of the cylinder B360 of the jaws is stretched out, so that the two
c、两组升降控制组件的电机A131启动,驱动两条同步带135同步运转,进而通过同步带135与底座31两侧连接块312的固连关系,带动搬运总成下降至其移动行程的最下端,从而做好转运准备。c. The motors A131 of the two sets of lifting control components start to drive the two
S05,转运垃圾容器:S05, Transfer garbage container:
基于摄像头的提供的视觉支持,控制电动滚轮12动作,将垃圾容器转运机器人移动至卸载垃圾的指定地点。Based on the visual support provided by the camera, the action of the
S06,夹取第二个垃圾容器:S06, grabbing the second garbage container:
a、两组升降控制组件的电机A131启动,驱动两条同步带135同步运转,进而通过同步带135与底座31两侧连接块312的固连关系,带动低位托盘34上升至高于卸载平面;a. The motors A131 of the two sets of lifting control components are started to drive the two
b、翻转组件的双轴电机365启动,驱动夹爪向下转动一定角度,使夹爪的夹持口将第二个垃圾容器包容在内;b. The
c、夹爪的气缸B360活塞杆伸出,使两个夹臂367相向移动,直至夹紧第二个垃圾容器的外壁。c. The piston rod of the cylinder B360 of the jaws stretches out, so that the two clamping
S07,将第二个垃圾容器转移至卸载平面上:S07, transfer the second garbage container to the unloading plane:
a、同时执行以下几项操作:a. Perform the following operations at the same time:
1、翻转组件的双轴电机365启动,驱动夹爪向上转动一定角度,与此同时,两个舵机B368同步启动,带动两个橡胶夹盘369和第二个垃圾容器转动,使第二个垃圾容器在向上转动的过程中始终保持竖直不倾斜;1. The double-
2、四组往复推送组件的舵机A368同步启动,驱动四条摇臂323同步向主体车架11后端摆动,使搬运总成向主体车架11后端移动;2. The servos A368 of the four groups of reciprocating push components are started synchronously, and the four
3、两组水平推拉组件的气缸A361的活塞杆同步伸出,推动翻转组件、夹爪和第二个垃圾容器向主体车架11后端移动;3. The piston rods of the cylinders A361 of the two sets of horizontal push-pull assemblies are extended synchronously, pushing the turning assembly, the grippers and the second garbage container to move to the rear end of the main body frame 11;
上述三项操作完成时,第二个垃圾容器伸出在主体车架11后端外部;When the above three operations were completed, the second garbage container stretched out from the outside of the main body frame 11 rear end;
b、翻转组件的双轴电机365启动,驱动夹爪向下转动一定角度,与此同时,两个舵机B368同步启动,带动两个橡胶夹盘369和被第二个垃圾容器转动,使第二个垃圾容器在向下转动的过程中始终保持竖直不倾斜;从而使第二个垃圾容器的高度降低并贴近卸载平面;b. The double-
c、夹爪的气缸B360活塞杆伸出,使两个夹臂367背向移动至极限位置,从而松开第二个垃圾容器的外壁两侧,第二个垃圾容器即落在卸载平面上;c. The piston rod of the cylinder B360 of the jaws is stretched out, so that the two
本步骤中,对双轴电机365与舵机B368的协调控制基于角度倾斜传感器的实时检测数据。In this step, the coordinated control of the
S08,夹取第一个垃圾容器:S08, grab the first garbage container:
a、翻转组件的双轴电机365启动,驱动夹爪向主体车架11前端翻转;以此同时,两组水平推拉组件的气缸A361的活塞杆同步缩回,推动翻转组件和夹爪向主体车架11前端移动;通过上述两项操作,使夹爪的夹持口正对并包容第一个垃圾容器;a. The
b、夹爪的气缸B360活塞杆缩回,以使两个夹臂367相向移动至夹紧第一个垃圾容器的外壁两侧。b. The piston rod of the cylinder B360 of the clamping jaw is retracted, so that the two clamping
S09,将第一个垃圾容器转移至卸载平面上:S09, transfer the first garbage container to the unloading plane:
a、同时执行以下几项操作:a. Perform the following operations at the same time:
1、翻转组件的双轴电机365启动,驱动夹爪向主体车架11后端翻转;与此同时,两个舵机B368同步启动,带动两个橡胶夹盘369和第一个垃圾容器转动,使第一个垃圾容器在翻转的过程中始终保持竖直不倾斜;1. The double-
2、两组两组水平推拉组件的气缸A361的活塞杆同步伸出,推动翻转组件、夹爪和第一个垃圾容器向主体车架11后端移动;2. The piston rods of the cylinders A361 of the two groups of horizontal push-pull assemblies extend out synchronously, pushing the turning assembly, the grippers and the first garbage container to move to the rear end of the main body frame 11;
上述两项操作完成后,第一个垃圾容器伸出在主体车架后端外部;After the above two operations are completed, the first garbage container protrudes outside the rear end of the main body frame;
c、翻转组件的双轴电机365启动,驱动夹爪向下转动一定角度,与此同时,两个舵机B368同步启动,带动两个橡胶夹盘369和第一个垃圾容器转动,使第二个垃圾容器在向下转动的过程中始终保持竖直不倾斜;从而使第一个垃圾容器的高度降低并贴近卸载平面;c. The double-
d、夹爪的气缸B360活塞杆伸出,使两个夹臂367背向移动至极限位置,从而松开第一个垃圾容器的外壁两侧,第一个垃圾容器即落在卸载平面上;d. The piston rod of the cylinder B360 of the jaws is stretched out, so that the two
本步骤中,对双轴电机365与舵机B368的协调控制基于角度倾斜传感器的实时检测数据。In this step, the coordinated control of the
S10,机构复位:S10, mechanism reset:
a、四组往复推动组件的摇臂323向主体车架11前端摆动至极限位置;a. The
b、两组升降驱动组件的同步带135带动搬运总成向下移动至极限位置;b. The
c、两组水平推拉组件的气缸A361的活塞杆缩回,使夹爪和翻转组件向主体车架11前端移动;c. The piston rods of the cylinders A361 of the two sets of horizontal push-pull components are retracted, so that the jaws and the turning components move to the front end of the main body frame 11;
d、翻转组件的双轴电机365启动,驱动夹爪转动至朝向主体车架11前端;d. The
上述四项操作同时执行,上述四项操作完成时,搬运总成回到两个竖向支架112之间的载物区间113中,并处在其移动行程的最低位置。The above four operations are performed simultaneously, and when the above four operations are completed, the transfer assembly returns to the
S11,投放垃圾:S11, throwing out garbage:
基于摄像头的提供的视觉支持,一方面控制电动滚轮动作以调整垃圾容器转运机器人的位姿,另一方面控制机械抓手总成动作,从而依次夹取两个垃圾容器中的垃圾袋,投放至指定的垃圾桶中。Based on the visual support provided by the camera, on the one hand, the action of the electric roller is controlled to adjust the posture of the garbage container transfer robot; in the designated trash can.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210410192.8A CN114800425B (en) | 2022-04-19 | 2022-04-19 | Garbage container transfer robot and method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210410192.8A CN114800425B (en) | 2022-04-19 | 2022-04-19 | Garbage container transfer robot and method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114800425A CN114800425A (en) | 2022-07-29 |
CN114800425B true CN114800425B (en) | 2023-06-02 |
Family
ID=82504926
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210410192.8A Expired - Fee Related CN114800425B (en) | 2022-04-19 | 2022-04-19 | Garbage container transfer robot and method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114800425B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3922417B1 (en) * | 2020-06-09 | 2023-06-07 | Mobile Industrial Robots A/S | Gripping system for an autonomous guided vehicle |
CN118044402B (en) * | 2024-04-16 | 2024-07-26 | 中国科学院长春光学精密机械与物理研究所 | Crawler type cross-ridge walking picking equipment |
CN119568953A (en) * | 2025-02-08 | 2025-03-07 | 山西继禹工程机械有限公司 | A disassembly and assembly robot for mine equipment maintenance |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101134313A (en) * | 2007-09-29 | 2008-03-05 | 北京博创兴盛机器人技术有限公司 | Robot for eliminating exploding and danger |
JP2017007066A (en) * | 2015-06-25 | 2017-01-12 | トヨタ自動車株式会社 | Robot fall prevention method |
CN108360428A (en) * | 2018-04-20 | 2018-08-03 | 吉林大学 | It is a kind of to be used for rubbish automatic Picking, carrying and the sanitation robot of unloading and its control method |
CN209242119U (en) * | 2018-12-11 | 2019-08-13 | 吉林大学 | A robot for intelligent handling and unloading of dustbins |
CN110653790A (en) * | 2019-10-25 | 2020-01-07 | 河南大学 | An AGV robot for handling large shaped parts |
CN110788870A (en) * | 2019-11-05 | 2020-02-14 | 长沙理工大学 | A kind of robot for hanging ground wire of power distribution overhead line and its operation method |
-
2022
- 2022-04-19 CN CN202210410192.8A patent/CN114800425B/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101134313A (en) * | 2007-09-29 | 2008-03-05 | 北京博创兴盛机器人技术有限公司 | Robot for eliminating exploding and danger |
JP2017007066A (en) * | 2015-06-25 | 2017-01-12 | トヨタ自動車株式会社 | Robot fall prevention method |
CN108360428A (en) * | 2018-04-20 | 2018-08-03 | 吉林大学 | It is a kind of to be used for rubbish automatic Picking, carrying and the sanitation robot of unloading and its control method |
CN209242119U (en) * | 2018-12-11 | 2019-08-13 | 吉林大学 | A robot for intelligent handling and unloading of dustbins |
CN110653790A (en) * | 2019-10-25 | 2020-01-07 | 河南大学 | An AGV robot for handling large shaped parts |
CN110788870A (en) * | 2019-11-05 | 2020-02-14 | 长沙理工大学 | A kind of robot for hanging ground wire of power distribution overhead line and its operation method |
Also Published As
Publication number | Publication date |
---|---|
CN114800425A (en) | 2022-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114800425B (en) | Garbage container transfer robot and method | |
CN108341257B (en) | A sanitation robot used for transporting and unloading garbage bins and its control method | |
CN108655582B (en) | Full-automatic battery case welding and cutting all-in-one machine | |
CN110510403B (en) | Automatic unloading equipment of going up of difunctional fast switch over | |
CN110817325B (en) | Blanking system of engine cylinder block | |
CN1189361C (en) | Method and apparatus for unpacking | |
CN110841932A (en) | Carton detects sorting device | |
CN112719616B (en) | Automatic glue shell radium carving machine | |
CN114310040A (en) | Elastic diaphragm welding equipment | |
CN218052590U (en) | Rack assembly of garbage container transfer robot | |
CN217145781U (en) | Handling device of garbage container transfer robot | |
CN210763113U (en) | Double-functional fast switching automatic feeding and discharging equipment | |
CN220865878U (en) | Automatic packaging production line | |
CN101259763B (en) | Powder press product discharge automatic pick-up cleaning conveying system | |
CN114890023B (en) | Sanitation transfer vehicle and transfer method thereof | |
CN214452248U (en) | Welding rod automatic weighing step-by-step packaging production line | |
CN214692125U (en) | A kind of PCB inner pressing process section equipment and its reclaiming workbench | |
CN212826400U (en) | Feeding machine for lens edge trimmer | |
CN115283672A (en) | Automatic material-taking code disc equipment of servo alloy powder press robot | |
CN211393288U (en) | Full self-cleaning scraper production line | |
CN217588671U (en) | Inductor assembling machine | |
CN112093480A (en) | PCB (printed circuit board) intrinsic lamination process section equipment and material taking workbench thereof | |
CN217649732U (en) | Automatic ton bag of rectifying goes up bagging machine | |
CN218369779U (en) | Sanitation transfer car | |
CN217493123U (en) | Welding machine for upper handle and lower shield of gas tank |
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: 20230602 |