CN101870106A - 自动跟随平衡系统 - Google Patents
自动跟随平衡系统 Download PDFInfo
- Publication number
- CN101870106A CN101870106A CN201010186697A CN201010186697A CN101870106A CN 101870106 A CN101870106 A CN 101870106A CN 201010186697 A CN201010186697 A CN 201010186697A CN 201010186697 A CN201010186697 A CN 201010186697A CN 101870106 A CN101870106 A CN 101870106A
- Authority
- CN
- China
- Prior art keywords
- automatic
- robot
- manual
- vehicle
- chassis
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
- Motorcycle And Bicycle Frame (AREA)
Abstract
本发明的目的在于提供自动跟随平衡系统。本发明包括连接在被夹持物体两端的自动机器人和手动机器人;自动机器人包括自动车底盘、自动车升降杆、自动车俯仰转轴、自动车夹持手部,自动车升降杆安装在自动车底盘上,自动车夹持手部通过自动车俯仰转轴安装在自动车升降杆上;手动机器人包括手动机器人手部、倾角传感器、倾角传感器安装盒、手动机器人俯仰转轴、手动车升降杆和手动车底盘,手动车升降杆安装在手动车底盘上,倾角传感器安装在倾角传感器倾角安装盒中,传感器安装盒固定在手动机器人手部,手动机器人手部通过手动机器人俯仰转轴安装在手动车升降杆上。本发明能动态测量被搬运物体的倾斜角度,测量效果较好。
Description
技术领域
本发明涉及的是一种机械结构,具体地说是应用于快速运动中姿态测量的移动机器人结构。
背景技术
水平姿态测量广泛地应用在移动平台的稳定调节、机器人的自动控制、微波通信天线的自动跟踪、勘探等很多领域中。目前常用的倾角测量传感器有:加速度传感器、导电液倾角传感器、电感式、电阻式、应变式、悬挂式等。导电液倾角传感器主要有单轴和双轴两种,其中双轴导电液倾角传感器由于横向耦合干扰的影响会产生测量误差,特别是对于高精度要求的测量场合,应考虑耦合干扰的影响。
移动机器人应用在自然环境中,势必会遇到地面凹凸不平的状况,这就要求具有协同作业的两独立机器人有很好的平衡响应能力。
在移动机器人比赛中,自动机器人和手动机器人在没有通讯的情况下,共同抬一柄长为2米的轿子,在保证轿杆始终水平的情况下,需要完成翻越坡度为17.5°(中间水平坡段长度为1米),跨度为3米的山坡,并且在完成翻越山坡任务时,必须保持车体和轿杆的平稳;完成翻山任务后,还要保证机器人能灵活、快速绕过障碍物,完成规定动作,这就要求机器人手部升降跟随系统响应灵活快速,能快速根据地面和车体倾斜情况作出姿态调整。
发明内容
本发明的目的在于提供能够在快速运动中实时姿态测量的、能够适应恶劣工作环境的自动跟随平衡系统。
本发明的目的是这样实现的:
本发明自动跟随平衡系统,其特征是:包括连接在被夹持物体两端的自动机器人和手动机器人;自动机器人包括自动车底盘、自动车升降杆、自动车俯仰转轴、自动车夹持手部,自动车升降杆安装在自动车底盘上,自动车夹持手部通过自动车俯仰转轴安装在自动车升降杆上;手动机器人包括手动机器人手部、倾角传感器、倾角传感器安装盒、手动机器人俯仰转轴、手动车升降杆和手动车底盘,手动车升降杆安装在手动车底盘上,倾角传感器安装在倾角传感器倾角安装盒中,传感器安装盒固定在手动机器人手部,手动机器人手部通过手动机器人俯仰转轴安装在手动车升降杆上。
本发明的优势在于:能动态测量被搬运物体的倾斜角度,测量效果较好。
附图说明
图1为本发明的自动跟随平衡系统夹持物体上坡姿态图;
图2是本发明的自动跟随平衡系统夹持物体在坡上姿态图;
图3是本发明的自动跟随平衡系统夹持物体下坡姿态图;
图4是本发明的控制系统原理图;
图5是本发明的加速度传感器坐标系与倾角关系示意图。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1~5,本发明包括连接在被夹持物体两端的自动机器人和手动机器人;自动机器人包括自动车底盘2、自动车升降杆3、自动车俯仰转轴4、自动车夹持手部5,自动车升降杆3安装在自动车底盘2上,自动车夹持手部5通过自动车俯仰转轴4安装在自动车升降杆3上;手动机器人包括手动机器人手部9、倾角传感器、倾角传感器安装盒10、手动机器人俯仰转轴11、手动车升降杆12和手动车底盘13,手动车升降杆12安装在手动车底盘13上,倾角传感器安装在倾角传感器倾角安装盒10中,传感器安装盒10固定在手动机器人手部9,手动机器人手部9通过手动机器人俯仰转轴11安装在手动车升降杆12上。
图1中,自动跟随平衡系统处于上坡阶段,自动跟随平衡系统夹持的物体由轿杆6、钢丝绳7和轿子底板8组成,自动机器人处于山坡1之上,手动机器人位于地面为保证轿杆6水平,通过测量倾角,手动车升降杆12提升,保证轿杆6水平。随着自动车爬坡,以及手动车自身车速,通过倾角传感器测量倾角,调整升降杆。
图2中,手动机器人处于山坡1之上,为保证轿杆6水平,手动机器人需根据倾角时刻调整升降杆位置。
图3中,手动机器人处于下坡阶段,车体倾斜,保证轿杆6水平。
图4中,说明了倾角数据传输及处理过程,ADXL203具有信号可调节的电压输出,输出量为两路与加速度成比例的模拟电压信号。比例系数达到1000mV/g。ADXL103传感器测量电路安装在手动车的可升降俯仰杆10处,当手动车在移动过程中,俯仰杆处于不同位置时,传感器的两个敏感轴会根据角度的变化而输出相应的模拟量,然后将信号送人单片机ATmega8中,经过单片机进一步处理运算(模数转换),将合成的数字量通过MAX485总线传送给主控,控制升降杆的升降以保证俯仰杆的平衡。
图5中,给出了角度测量原理图,ADXL203用作倾斜度测量时,以重力矢量作为基准,将它的X轴沿水平车体前进方向,Y轴沿重力加速度g方向,此时定义为0°。此时加速度传感器ADXL203处于竖直平面内,。当车体底盘处于水平面时,为保证平衡杆保持水平,必须使重力加速度在ay轴的投影为G;当车体底盘处于倾角为θ的斜面上时,为保证平衡杆保持水平,后车必须升高到一定高度使得加速度计的坐标系axoay与坐标系goa成θ角。
当车体倾斜时,车体前冲加速度对倾角传感器两轴的测量量均有影响,而ax、ay测量的仅为重力加速度在其上的分量,为消除前冲的水平加速度的影响,当θ值很小时,可以将cosθ近似看做1,此时方程可简化为
ay-ax*Sinθ=g
由于倾角传感器有很高的跟随速度,所以可以保证θ值是很小值,使之保持在5°以下,此时方程可进一步简化为
通过得出的θ值,在主控制系统中进行角度补偿,控制升降杆升降,再通过倾角测量进行反馈控制,使轿杆保证水平。
Claims (1)
1.自动跟随平衡系统,其特征是:包括连接在被夹持物体两端的自动机器人和手动机器人;自动机器人包括自动车底盘、自动车升降杆、自动车俯仰转轴和自动车夹持手部,自动车升降杆安装在自动车底盘上,自动车夹持手部通过自动车俯仰转轴安装在自动车升降杆上;手动机器人包括手动机器人手部、倾角传感器、倾角传感器安装盒、手动机器人俯仰转轴、手动车升降杆和手动车底盘,手动车升降杆安装在手动车底盘上,倾角传感器安装在倾角传感器倾角安装盒中,传感器安装盒固定在手动机器人手部,手动机器人手部通过手动机器人俯仰转轴安装在手动车升降杆上。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010101866978A CN101870106B (zh) | 2010-05-31 | 2010-05-31 | 自动跟随平衡系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010101866978A CN101870106B (zh) | 2010-05-31 | 2010-05-31 | 自动跟随平衡系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101870106A true CN101870106A (zh) | 2010-10-27 |
CN101870106B CN101870106B (zh) | 2011-08-03 |
Family
ID=42995278
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010101866978A Expired - Fee Related CN101870106B (zh) | 2010-05-31 | 2010-05-31 | 自动跟随平衡系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101870106B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506801A (zh) * | 2011-10-20 | 2012-06-20 | 奇瑞汽车股份有限公司 | 一种直接测量主销后倾角的辅助工具 |
CN104472042A (zh) * | 2014-11-25 | 2015-04-01 | 上海长语信息科技有限公司 | 山坡轨基机器人系统 |
CN109895136A (zh) * | 2017-12-10 | 2019-06-18 | 湘潭宏远电子科技有限公司 | 一种机器人平衡装置 |
CN109895141A (zh) * | 2017-12-10 | 2019-06-18 | 湘潭宏远电子科技有限公司 | 一种机器人减速装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1395400A1 (ru) * | 1986-11-17 | 1988-05-15 | Днепропетровский Завод Металлургического Оборудования | Реечный холодильник |
JPH08308309A (ja) * | 1995-05-18 | 1996-11-26 | Satoshi Hayashi | 整地装置 |
CN201335984Y (zh) * | 2008-12-30 | 2009-10-28 | 上海太腾机械设备有限公司 | 用于全液压动力车的货物平台自动调平装置 |
CN101648525A (zh) * | 2008-08-14 | 2010-02-17 | 邹长江 | 上下楼车 |
-
2010
- 2010-05-31 CN CN2010101866978A patent/CN101870106B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1395400A1 (ru) * | 1986-11-17 | 1988-05-15 | Днепропетровский Завод Металлургического Оборудования | Реечный холодильник |
JPH08308309A (ja) * | 1995-05-18 | 1996-11-26 | Satoshi Hayashi | 整地装置 |
CN101648525A (zh) * | 2008-08-14 | 2010-02-17 | 邹长江 | 上下楼车 |
CN201335984Y (zh) * | 2008-12-30 | 2009-10-28 | 上海太腾机械设备有限公司 | 用于全液压动力车的货物平台自动调平装置 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506801A (zh) * | 2011-10-20 | 2012-06-20 | 奇瑞汽车股份有限公司 | 一种直接测量主销后倾角的辅助工具 |
CN104472042A (zh) * | 2014-11-25 | 2015-04-01 | 上海长语信息科技有限公司 | 山坡轨基机器人系统 |
CN109895136A (zh) * | 2017-12-10 | 2019-06-18 | 湘潭宏远电子科技有限公司 | 一种机器人平衡装置 |
CN109895141A (zh) * | 2017-12-10 | 2019-06-18 | 湘潭宏远电子科技有限公司 | 一种机器人减速装置 |
Also Published As
Publication number | Publication date |
---|---|
CN101870106B (zh) | 2011-08-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102923572B (zh) | 一种吊车负载空间摆角检测技术及装置 | |
CN101709975B (zh) | 一种航空遥感惯性稳定平台不平衡力矩估计与补偿方法 | |
US10524403B2 (en) | Method for determining a weight of a payload for a utility vehicle | |
CN101870106B (zh) | 自动跟随平衡系统 | |
CN110672017B (zh) | 一种激光位移传感器振动补偿平台 | |
CN107478312B (zh) | 一种动静两用货车称重系统及称重方法 | |
CN109459121A (zh) | 一种飞机吊舱重量重心测量方法 | |
CN103600354A (zh) | 航天器机械臂柔性随动控制重力补偿方法 | |
KR20110052563A (ko) | 차량용 휠 서스펜션 | |
CN108819651A (zh) | 一种应急救援车辆的车身姿态调平控制系统及方法 | |
CN107314803A (zh) | 一种农机车载称重系统及其称重方法 | |
CN109032156B (zh) | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 | |
CN203269481U (zh) | 一种适用于叉脚式叉车的载荷称重及载荷重心测量装置 | |
CN109606732A (zh) | 一种高效的飞机质量特性测量方法 | |
CN1669874A (zh) | 一种用于飞行器的自动驾驶仪 | |
CN2681997Y (zh) | 一种具有双处理器的飞行器自动驾驶仪 | |
WO2023173744A1 (zh) | 一种综合高精度智能车辆实时称重方法及其系统 | |
CN108204849A (zh) | 一种轮式起降小型无人机用称重定重心方法 | |
CN204007822U (zh) | 一种用于拖拉机安全检测线的动态称重装置 | |
Vihonen et al. | Geometry-aided angular acceleration sensing of rigid multi-body manipulator using mems rate gyros and linear accelerometers | |
CN108773796B (zh) | 一种叉车上任意两点坐标系的标定方法 | |
CN101832834B (zh) | 用于失重环境下攀爬训练的抓杆测力装置 | |
Engin | Embedded LQR controller design for self-balancing robot | |
CN106403933A (zh) | 一种惯性航向姿态系统的磁航向信号补偿和检测方法 | |
CN105565163B (zh) | 一种桥式起重机吊钩钢丝绳偏摆角检测装置及检测方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20110803 Termination date: 20170531 |
|
CF01 | Termination of patent right due to non-payment of annual fee |