专利名称：平地机智能调平系统及其调平方法
技术领域：
本发明属于平地机调平系统及方法，特别是涉及一种可以使平地机快速高效的进行 自动调平作业，适应普通道路横坡、弯道超高、道路缓和线等横向坡度按一定规律变化 的精确控制的平地机智能调平系统及其调平方法。
背景技术：
平地机，顾名思义就是平整场地、路面的机械。平地机作业时，铲刀相对于地面的 位置决定着其工作质量，也就是路面的平整度。平地机的工作装置铲刀是安装在一个可 以水平回转、垂直摆动和横向伸缩的机架上，通过各控制液压油缸的动作，控制铲刀升 降、回转、倾斜、引出和萨土角度变换。在平地机作业时，司机通常必须随时调整铲刀 的空间位置，使铲刀刮整的路面尽量平整而减少因为整机行驶颠簸不平造成的影响。司机驾驶方向盘的旁边通常有IO个不同的手动控制阀杆,其中6个直接用于控制铲刀位置。 为了获得较好的平地效果，司机必须要有娴熟的操作技术，要根据平地机行驶状况不断 的对铲刀进行调整。因此平地机司机的操作劳动强度较大。如果司机没有及时正确的调 整铲刀位置，铲刀底缘刮出的表面就会随着整机的起伏而起伏，甚至使铲刀短时铲土过 深、机器过载而减速换档和提铲，造成施工表面局部高低不平，极大的影响作业路面平 整度和生产率。CN200520011494.X的实用新型专利公开了一种平地机自动找平系统，包括用于測量 铲刀的位置参数信息的传感器、用于控制铲刀油缸的比例阀组、用于设定系统参数及施 工参数及显示铲刀的实时位置参数信息的操作界面、用于接收传感器采集的实时信息的 主控器，主控器根据传感器采集的数据经过相应的运算与设定值进行比较，再将相应的 信号输出到比例阀组，控制铲刀复位，传感器及操作界面通过CAN总线与主控器相连， 比例阀组的信号输入端与主控器的信号输出端相连，比例阀组与平地机的液压系统相连。 本系统可以使平地机按照操作员预先设定的纵坡及横坡值进行自动控制，从而实现平地 机的自动操作，保证平地机按照设定值进行精确平整。该专利所描述的平地机自动调平系统，必须依靠道路边缘进行作业，对于道路中部 或不便设置施工基准的场地，应用受到限制在操作上主要控制按钮与手动阀控制杆在 一起，容易产生误动作。美国专利US6278955平地机自动调平到预定位置的方法，提出了一种系统和方法， 用于自动调节平地机炉刀到操作者预编程的伊刀位置。该方法包含的步骤是l.提供一个 电子控制器及具有位置传感器的铲刀控制装置2.监测位置传感器的输出，以确定控制铲 刀的位置3.接受第一输入信号用于设置铲刀记忆位置；4.根据位置传感器的输出确定记
忆伊刀位置5.接受第二输入信号要求记忆铲刀位置；6.根据输出的位置传感器确定当前 伊刀位置；7.产生控制信号,作用于铲刀控制装置以便将铲刀从当前位置移动到存储铲刀 位置。该专利是用于控制操作员输入记忆铲刀的位置，根据位置传感器的反馈信号确定铲 刀当前位置，并将根据要求的记忆铲刀位置控制铲刀从当前位置移动到存储铲刀位置。 主要用于快速调整铲刀的基本工作位置，而不是用于平地机与地面的相对位置变化而调 整铲刀进行实时的调平作业。美国专利US5107932平地机控制铲刀的装置和方法，提出了铰接式平地机控制横坡 角的一种方法和装置，通过铲刀回转转向，在直线行驶、蟹形转向和非水平面行驶的情 况。铲刀角度被监测和控制使铲刀角度保持大致相等计算铲刀角度。第一个体现，铲刀 角度计算是用公式BS := sin (t， ) . tan (R) + cos (t， ) . tan (CS) 这里，BS是要求的铲刀与水平面的夹角，T'是铲刀相对于伊刀运动在水平面的投影方向的夹角，R是铲刀行驶方向和水平面的夹角，而CS是希望的横坡角，由操作人员输入的控制角度。在进一步的体现，铲刀角度计算是用公式BS :=sin (t， ， ) .tan (R， ) + cos (t， ， ) .tan (CS)这里，BS是要求的铲刀与水平面的夹角，T"是铲刀相对于铲刀运动在水平面的投影 方向的夹角，其前轮转向装置处的横坡角为零，R'是铲刀行驶方向和水平面的夹角，其 前轮转向装置处的横坡角为零，而CS是希望的横坡角。这仅仅平地机一种调平的一端控制数学模型，而不是一套完整的平地机调平控制系统。发明内容本发明为解决公知技术中存在的技术问题而提供一种可以使平地机快速高效的进行 自动调平作业，适应普通道路横坡、弯道超高、道路缓和线等横向坡度按一定规律变化 的精确控制的平地机智能调平系统及其调平方法。本发明为解决公知技术中存在的技术问题所采取的技术方案是 一种平地机智能调 平系统及其调平方法，其平地机智能调平控制系统，包括有根据铲刀空间位置监测传 感器接收平地机铲刀位置的信号，并自动向控制铲刀油缸的电控液压阀发出控制信号的 自动调平电控系统，和接收自动调平电控系统的控制信号驱动伊刀自动调平的自动调平 液压系统。所述的自动调平电控系统包括有在平地机上设置的安装在铲刀上部的用于监测 铲刀与水平面的倾斜状态的铲刀倾斜传感器安装在铲刀回转盘上的用于监测伊刀回转 角度的铲刀回转传感器；安装在平地机前机架上的用于监测行驶的纵向坡度的机架倾斜
传感器；控制铲刀油缸的且设置在自动调平液压系统中的左升降油缸电控阀和右升降油 缸电控阀；安装在铲刀一侧的用于跟踪作业路面基准的铲刀髙程传感器和铲刀距离传感 器；以及根据接收各传感器信号向左升降油缸电控阀和右升降油缸电控阀发出控制信号 的调平控制器和监控显示器，其中，调平控制器分别与铲刀倾斜传感器、铲刀回转传感 器、机架倾斜传感器、左升降油缸电控阓和右升降油缸电控阀、铲刀髙程传感器、铲刀 距离传感器以及监控显示器相连接。在平地机上还安装有与调平控制器相连的整机行驶速度传感器。 在铲刀的一侧或中部还安装有与调平控制器相连的带差分GPS卫星定位装置。 所述的自动调平液压系统包括有控制液体流入的优先阀；分别与优先阀的输出端 相连的第一、第二调速节流阀分别对应连接在两个调速节流阀的输出端上且受自动调 平电控系统中调平控制器控制的左升降油缸电控阀和右升降油缸电控阀；分别与优先阀 的输出端相连的第一、第二手动控制阀；与左升降油缸电控阀和第一手动控制阀相连的 第一双向液压锁及与右升降油缸电控阀和第二手动控制阀相连的第二双向液压锁以及 分别对应与两个双向液压锁的输出端相连，驱动铲刀动作的左升降油缸和右升降油缸； 上述的部件之间是通过液压管路相连接的。本发明的平地机智能调平控制系统的控制方法，包括有如下阶段 第一阶段初始化阶段第二阶段判断是否进行参数设置的阶段；是，则调用参数设置子程序，然后返回 主程序；第三阶段在第二阶段中判断不进行参数设置时，继续判断是否进行参数标定？是， 则调用参数标定子程序，然后返回主程序，否则直接返回主程序； 第四阶段判断是否进行自动调平阶段；第五阶段在第四阶段中判断结果为是，则继续判断是否进行手动微调的阶段； 第六阶段在第五阶段中判断结果为是，则进入手动微调的调整阶段，然后进入第 十三阶段第七阶段在第五阶段中判断结果不进行手动微调，则进入高度调平子程序的阶段； 第八阶段执行高度调平子程序结束后，返回主程序后进入角度调平子程序的阶段； 第九阶段:执行角度调平子程序结束后,返回主程序后,判断控制模式是否为M=0 第十阶段在第九阶段中判断结果是M-O,设定其左升阀为高度调平升，左降阀为高度调平降；设定其右升阀为角度调平升，右降阀为角度调平降，然后进入第十三阶段； 第十一阶段在第九阶段中判断结果是M#0,设定其右升阀为髙度调平升，右降阀为高度调平降；设定其左升阀为角度调平升，右降阀为角度调平降，然后进入第十三阶段；第十二阶段在第四阶段中判断结果不是进行自动调平，则设定左、右升降阀都为 零，然后进入第十三阶段； 第十三阶段将调制的控制信号输出至升降油缸电控阀(4a、 4),然后结束一个控 制循环周期。所述的参数设置子程序包括有如下步骤(1) 输入控制模式M=0、 M-l;(2) 判断控制模式是否为M=0 是，则将左升降阀设定为髙度控制阀，右升降阀设 定为角度控制阀，否则，将右升降阀设定为高度控制阀，左升降阀设定为角度控制阀；(3) 输入角度模式A=0、 A=l、 A=2:(4) 判断控制模式是否为A=0 (5) 当控制模式为A-O时，输入控制角度a后进入第(11)步；(6) 当控制模式为A^)时，继续判断控制模式是否为A-l (7) 当控制模式为A-1时，输入道路数ai、 si后进入第(11)步；(8) 当控制模式为A^时，继续判断控制模式是否为A=2 (9) 当控制模式为八=2时，输入道路数ai、 si、 Yi后进入第(11)步；(10) 当控制模式为A^2时，直接进入第(11)步；(11) 判断参数设置是否完毕？未完，则返回第(1)步继续设置，是设置完毕则返 回主程序。所述的参数标定子程序包括有如下步骤(1) 判断是否进行高度标定？(2) 在第(1)步的判断为是，则继续判断控制模式是否为M=0 当判断结果为M#0 时，进入第(4)步；(3) 在第(2)步的判断是M=0时，则将左控制阀设为高度控制阀，并设置控制 高度H-当前左高度否则，将右控制阀设为高度控制阀，并设置控制高度H-当前右 髙度(4) 判断是否标定机架倾斜角0 判断结果为是，则输入机架倾斜角<D的监测值和 实际值，并计算偏差AO-监测值一实际值，然后进入第(10)步(5) 在第(4)步的判断结果为否，则继续判断是否标定铲刀倾斜角e 是，则输入铲刀倾斜角e的监测值和实际值，并计算偏差Ae-监测值一实际值，后进入第(io)步；(6) 在第(5)步的判断结果为否，则继续判断是否标定铲刀回转角P 判断结果为 是，则输入铲刀(9)回转角卩的监测值和实际值，并计算偏差厶卩=监测值一实际值， 后进入第(10)步；(7) 在第(6)步的判断结果为否，则继续判断是否标定铲刀距离d 判断结果为是， 则检测当前铲刀距离d,并设定横向距离基准D-d,然后进入第(10)步(8) 在第(7)步的判断结果为否，则继续判断是否标定行驶速度v 判断结果为是， 则输入驶速度v的监测值和实际值，并计算系数—实际值/监测值，然后进入第(10) 步； (9) 在第(8)步的判断结果为否，则继续判断是否标定铲刀方向角(o 判断结果 为是，则输入铲刀方向角Q)的监测值和实际值，并计算偏差A(O-监测值一实际值，然后 进入第(10)步；如果判断结果为不是，则直接进入第(10)步(10) 判断参数标定是否完成？如果完成，则返回主程序，未完成，则返回第(1) 步重复进行。所述的高度调平子程序包括有如下步骤(1) 输入髙程h,并计算偏差Ah-H—h;(2) 判断是否为横向测距？判断结果为是，则输入横向距离d,使 Ad=D—dAh=Ah—Adxtan (ai)然后进入第(3)步，如果判断结果为否，则直接进入第(3)步；(3) 判断偏差是否大于容许量？即|Ah|>Sh;判断结果为是，则运行PID控制模块后进入第(4)步；(4) 输入高度控制升量和高度控制降量的信息后，返回主程序(5) 在第(3)步的判断结果为否，则使高度控制升=0、高度控制降=0后，返回主程序。所述的角度调平子程序包括有如下步骤(1) 判断控制模式A-0 判断结果为是，则调入控制角度a,并采集实时数据铲 刀倾斜角e、铲刀回转角卩和机架倾斜角O,然后进入数学模式O进行计算，然后进入第(4) 步；(2) 在第(1)步的判断结果为A^0时，则继续判断控制模式A-1 判断结果为是， 则调入道路数据ai、 si,并采集实时数据铲刀倾斜角e、妒刀回转角P、机架倾斜角O和行驶速度V，然后进入数学模式1进行计算，然后进入第(4)步；(3) 在第(2)步的判断是控制模式A^l时，则继续判断控制模式A=2 判断结果 为是，则调入道路数据ai、 si、 yi,并采集实时数据铲刀倾斜角e、铲刀方向角(D和行 驶速度v,然后进入数学模式2;当A^2时，直接进入第(4)步；(4) 判断偏差是否大于容许值？即la'—ei〉5a,判断结果为是，则运行PID控制模 块，并输出角度控制升量和角度控制降量的信息后，返回主程序；(5) 在第(4)步的判断结果是偏差不大于容许值时，则输出角度控制升=0、角度控 制降=0后，返回主程序。本发明具有的优点和积极效果是由于本发明的平地机智能调平系统及其调平方法，引入了平地机行驶速度参数、铲刀横向距离传感器、GPS卫星定位装置，将道路数据输入于存储监控器，并通过控制软件，可以使平地机快速高效的进行自动调平作业，适应 普通道路横坡、弯道超髙、道路缓和线等横向坡度按一定规律变化的精确控制。从而保 证平地机按照施工标准的作业平整度。
图1是平地机侧面结构示意图 图2是图1的俯视图； 图3是图1中的局部示意图； 图4是平地机自动调平液压系统框图 图5是平地机自动调平电控系统框图； 图6是自动调平主控制流程框图； 图7是自动调平高度控制流程框图 图8是自动调平角度控制流程框图； 图9是自动调平参数设置流程框图； 图10是自动调平参数标定流程框图。 图中的标号分别是la 、 l一第一、第二手动控制阀；2a 、 2—第一、第二双向液压锁3a、 3—左升降 油缸和右升降油缸4a、 4一左、右升降油缸电控阀；5a、 5—第一、第二调速节流阀；6 —优先阀6; 7 —铲刀回转盘；8 —前机架；9 —铲刀；10 —调平控制器；ll一监控显示器; 12—铲刀倾斜传感器；13—铲刀回转传感器；14一机架倾斜传感器14: 15—铲刀高程传 感器；16 — f产刀距离传感器；17—整机行驶速度传感器；18—GPS卫星定位装置。
具体实施方式
为能进一步了解本发明的发明内容、特点及功效，兹例举以下实施例，并配合附图详细说明如下图l是平地机侧面结构示意图图2是图1的俯视图。实际作业时，平地机通过调 节铲刀9的左右升降油缸3、 3a，控制刮平铲刀9的空间位置，使铲刀9刮出的路基面满 足工程施工标准的要求。平地机铲刀9是一钢结构体，铲刀9底刃为一直线，当铲刀9 底刃左右两点P1、 P2的高度确定以后，随着平地机的行驶铲刀9底部刀刃就将形成一个 面。当平地机自身水平行驶时，如果P1、 P2的髙度保持相等，形成的就是水平面；如果 Pl、 P2的髙度差保持不变，形成的就是一定斜度的坡面。实际上平地机在未经整平的路 基上行驶时，机器自身随着路基的不平而颠簸，因此如果P1、 P2的相对机架8的高度保 持相等，铲刀9刀刃轨迹面就是路基面的仿形如果P1、 P2的髙度差保持不变，最终的 成形面是一定斜度的坡面，但复合了路基面的不平波形。平地机的自动调平系统，就是 要在平地机的实际作业中，使的髙度差相对于大地的水平基准保持不变，这样伊刀9刀 刃轨迹面是满足一定横向坡度的斜面，而过滤了路基面的不平波形的影响。在道路需要 改变横向坡度或有弯道超高要求的路段，自动调平系统可以根据线路设计的要求，及时 准确的调整P1、 P2的相对于大地的水平基准高度差，满足工程施工的标准要求。
图3是图1中的局部示意图，即反映出平地机道路横截面视图(图2中的道路M-M 截面)，可以看到道路横断面通常是道路中间髙，其两边低，这是为了道路排水的要求 而设计的。道路设计的横向坡度铲刀9与道路形成夹角P,则横向坡度在铲刀9底刃Pl-P2 方向上，a将改变为a',平地机行驶过程中，希望其铲刀9底刃P1-P2与水平面的夹角 e与道路斜线坡度a'吻合，由于各种因素影响实际行驶中这两者存在误差。自动调平系 统根据道路设计的横坡度a,各传感器监测的铲刀9实际空间位置参数数据，自动调节铲 刀9左右升降油缸3、 3a的动作，满足道路工程设计参数的要求。本发明的平地机智能调平控制系统，包括有根据铲刀空间位置监测传感器接收平 地机铲刀位置的信号，并自动向控制铲刀油缸的电控液压阀发出控制信号的自动调平电 控系统，和接收自动调平电控系统的控制信号驱动铲刀自动调平的自动调平液压系统。如图4所示，所述的自动调平液压系统包括有控制液体流入的优先阀6;分别与优 先阀6的输出端相连的第一、第二调速节流阀5a、 5;分别对应连接在两个调速节流阀 5a、 5的输出端上且受自动调平电控系统中调平控制器10控制的左升降油缸电控阀4a 和右升降油缸电控阀4:分别与优先阀6的输出端相连的第一、第二手动控制阀la、 1: 与左升降油缸电控阀4a和第一手动控制阀la相连的第一双向液压锁2a及与右升降油缸 电控阀4和第二手动控制阀1相连的第二双向液压锁2:以及分别对应与两个双向液压锁 2a、 2的输出端相连，驱动铲刀9动作的左升降油缸3a和右升降油缸3;上述的部件之 间是通过液压管路相连接的。系统压力油经过优先阀6首先满足电控阀4和4a的控制油液，多于的液压油再分配 给手动控制阀。自动调平时，铲刀9通常都在设计的理想位置附近， 一有偏差就立即进 行纠正调节，因此每次铲刀9调节其动作幅度较小，所需液压油也较少。采用调速节流 阀5和5a控制油流速度避免铲刀9超调，并保证控制信号相同时电控液压阀4或4a每 次的动作一致，4和4a阀的动作一致。由于采用了优先阀6，其他手动控制阀的动作不 会影响自动调平电控阀的动作；自动调平需要液压油量较少，大部分液压油分配给其他 手动控制阀，因此即使自动调平阀正在工作，对其他油缸、马达的手动控制几乎没有影喻如图5所示，所述的自动调平电控系统包括有在平地机上设置的安装在铲刀9 上部的用于监测铲刀与水平面的倾斜状态的铲刀倾斜传感器12;安装在伊刀回转盘7上 的用于监测铲刀回转角度的铲刀回转传感器13:安装在平地机前机架8上的用于监测行 驶的纵向坡度的机架倾斜传感器14;控制铲刀油缸的且设置在自动调平液压系统中的左升降油缸电控阀4a和右升降油缸电控阀4;安装在铲刀9 一侧的用于跟踪作业路面基准 的铲刀高程传感器15和铲刀距离传感器16,该传感器用于实时监测平地机伊刀与作业路 面基准髙度和水平距离的变化，系统监控据此对该侧铲刀升降电控液压阀实施控制以 及根据接收各传感器信号向左升降油缸电控阀4a和右升降油缸电控阀4发出控制信号的 调平控制器10和监控显示器11，其中，调平控制器10分别与铲刀倾斜传感器12、铲刀
回转传感器13、机架倾斜传感器14、左升降油缸电控阀4a和右升降油缸电控阀4、铲刀高程传感器15、铲刀距离传感器16以及监控显示器11相连接。在平地机上还安装有与调平控制器10相连的整机行驶速度传感器17。在铲刀9的一侧或中部还安装有与调平控制器10相连的带差分GPS卫星定位装置18。自动调平电控系统是本专利的核心，监控显示器ll用于设定自动调平模式、横坡角 度a、实时显示铲刀9的调平状态和报瞀指示，根据需要可以通过数据接口 (CAN、 USB 等)输入和存储当前道路施工数据。监控显示器ll的控制模式、横坡角度a的设定均采 用监控显示器ll配置的软键实现，可以简化控制线路，避免部分指令开关与手动液压阀 杆相连可能出现的误操作。高程传感器15安装在平地机前进的左侧(如图2)，跟踪基准绳或基准路缘S,检 测铲刀9底刃Pl点相对于基准的高程变化，并控制右侧油缸3的升降；铲刀9回转传感 器检测伊刀9相对于机架8水平回转角度p，而机架倾斜传感器14可以检测出平地机行 驶道路的纵向坡度9;根据道路设计的横坡角度ct,由控制模块内置数学模型可以计算出 设计要求的斜线坡度a':据此，将斜线坡度a'与实测反馈的铲刀9倾角e进行比较， 由两者的偏差调节左侧油缸3a的升降从而使两者接近相等。这种平地机自动调平的方法 可以满足一般道路工程施工的要求。自动调平电控系统的监测传感器还包括扩展传感器铲刀距离传感器16、整车速度 传感器17、 GPS卫星定位装置18以及道路施工数据输入接口.在这种扩展调平控制方 式中，铲刀距离传感器16监测铲刀9在道路横向上相对于基准绳或基准路缘的距离d, 用于髙程控制中引入横向移动对应的髙程修正量，提髙控制精度同时可以用于定位作 业过程中铲刀9左侧点Pl的位置。整车速度传感器17用于监测平地机的实时速度，计 算作业中相对于基准点(起始点)的距离，从而配合距离d定位铲刀9左侧点Pl的位置。 GPS装置18选用供货商在平地机使用范围内提供差分基站数据服务的卫星定位装置，其 定位精度达到厘米级别，可以满足平地机铲刀9自动调平系统的精度要求，GPS装置18 可以用来定位P2点(或P1-P2中点)位置。Pl、 P2点确定后，铲刀9斜线以及相应设 计斜线坡度a'就得到确定；据此与铲刀9实测倾角0进行比较，系统即可进行右侧炉刀 9的调节，满足工程施工技术指标要求。在这种扩展控制方式中，根据行驶速度计算的行驶距离、铲刀9横向偏移量d确定 Pl点水平位置，采用GPS装置18获得P2点水平位置。此时，若监控器预先输入并存储 了当前道路施工数据，则可以调出Pl、 P2两点的设计数据，计算出两点的理论坡度角(相 对于水平面)并根据铲刀9实际倾角e进行右侧铲刀9的调节，此时，道路的横坡角度 可以是变化的，调平控制器10可以实时计算当前位置产道的设计坡度W ,从而适合弯 道超髙、道路缓和线等横向坡度按一定规律变化的精确控制而在不使用本专利的方法 时，这种情况即使用其他的平地机自动调平系统(美国专利US5107932、中国专利CN200520011494.X〉也完全靠司机凭感觉来调整，平整度没有保证，更不能实现横向坡 度按规律变化的精确控制。采用基本传感器组的4种传感器，加上铲距离传感器16、整车速度传感器17可以实 现变坡度道路的调平控制。此时，以监控显示器ll软键或数据输入接口输入并存储道路 坡度随行驶距离的变化数据。平地机作业时，由行驶速度和时间计算出行驶距离，由此 可以调出相应的横向坡度a:萨刀9髙程传感器15检测铲刀9P1点相对于基准的高程变 化，铲刀9横向偏移量d监测引入了高程控制的修正量，使P1点高程控制更准确；结合 传感器检测的铲刀9水平回转角度p、机架8纵向坡度q)和调出的横坡角度a,可以计算 出铲刀9的理论斜线坡度a':据此，自动调平系统调节右侧铲刀9升降，使其实际倾角 e尽可能与a'接近相等，实现平地机整平道路并满足道路设计坡度的要求.在本实施例中，调平控制器10选用芬兰EPEC公司2023型工程机械用控制器；监 控显示器11选用德国GRAF公司AT72型显示器。如图6所示，平地机智能调平控制系统的控制方法，包括有如下阶段第一阶段初始化阶段第二阶段判断是否进行参数设置的阶段；是,则调用参数设置子程序，然后返回 主程序第三阶段在第二阶段中判断不进行参数设置时，继续判断是否进行参数标定？是， 则调用参数标定子程序，然后返回主程序，否则直接返回主程序 第四阶段判断是否进行自动调平阶段；第五阶段在第四阶段中判断结果为是，则继续判断是否进行手动微调的阶段； 第六阶段在第五阶段中判断结果为是，则进入手动微调的调整阶段，然后进入第 十三阶段其中，手动微调的调整阶段包括有如下的步骤(1) 判断是否按左升键，让左升阀得电？是，则让左升阀得电，否则进入下一歩；(2) 判断是否按左降键？是，则让左降阀得电，否则进入下一步；(3) 判断是否按右升键？是，则让右升阀得电，否则进入下一步(4) 判断是否按右降键？是，则让右降阀得电，第七阶段在第五阶段中判断结果不进行手动微调，则进入高度调平子程序的阶段； 第八阶段执行高度调平子程序结束后，返回主程序后进入角度调平子程序的阶段； 第九阶段:执行角度调平子程序结束后,返回主程序后,判断控制模式是否为M=0 第十阶段在第九阶段中判断结果是M=0,则左升降油缸电控阀4a为髙度调整阀， 设定其左升阀为高度调平升，左降阀为高度调平降；右升降油缸电控阀4为角度调整阀， 设定其右升阀为角度调平升，右降阀为角度调平降，然后进入第十三阶段第十一阶段:在第九阶段中判断结果是M邦,则右升降油缸电控阀4a为商度调整阀， 设定其右升阀为高度调平升，右降阀为高度调平降；左升降油缸电控阀4为角度调整阀，
设定其左升阀为角度调平升，右降阀为角度调平降，然后进入第十三阶段；第十二阶段在第四阶段中判断结果不是进行自动调平，则设定左、右升降阀都为零，然后进入第十三阶段第十三阶段将调制的控制信号输出至升降油缸电控阀4a、 4，然后结束一个控制循环周期。如图9所示，所述的参数设置子程序包括有如下步骤(1) 输入控制模式M-0、(2) 判断控制模式是否为M-0 是，则将左升降阀设定为髙度控制阀，右升降阀设 定为角度控制阀，否则，将右升降阀设定为高度控制阀，左升降阀设定为角度控制阀；(3) 输入角度模式A=0、 A=l、 A=2-(4) 判断控制模式是否为A=0 (5) 当控制模式为A-O时，输入控制角度a后进入第(11)步；(6) 当控制模式为A^)时，继续判断控制模式是否为A-1 (7) 当控制模式为A-1时，输入道路数ai、 si后进入第(11)步；(8) 当控制模式为A^时，继续判断控制模式是否为A=2 (9) 当控制模式为A-2时，输入道路数d、 si、 W后进入第(11)步；(10) 当控制模式为A^2时，直接进入第(11)步；(11) 判断参数设置是否完毕？未完，则返回第(1)步继续设置，是设置完毕则返 回主程序。如图IO所述的参数标定子程序包括有如下步骤(1) 判断是否进行高度标定？(2) 在第(1)步的判断为是，则继续判断控制模式是否为M=0 当判断结果为M#0 时，进入第(4)步；(3) 在第(2)步的判断是M-O时，则将左控制阀设为高度控制阀，并设置控制 高度H-当前左高度否则，将右控制阀设为高度控制阀，并设置控制高度H-当前右 高度；(4) 判断是否标定机架倾斜角<D 判断结果为是，则输入机架倾斜角0)的监测值和 实际值，并计算偏差A(D-监测值一实际值，然后进入第(10)步；(5) 在第(4)步的判断结果为否，则继续判断是否标定铲刀倾斜角e 是，则输入铲刀倾斜角e的监测值和实际值，并计算偏差Ae-监测值一实际值，后进入第(io)步；(6) 在第(5)步的判断结果为否，则继续判断是否标定伊刀回转角P 判断结果为 是，则输入铲刀(9)回转角卩的监测值和实际值，并计算偏差*=监测值一实际值， 后进入第(10)步(7) 在第(6)步的判断结果为否，则继续判断是否标定铲刀距离d 判断结果为是， 则检测当前铲刀距离d,并设定横向距离基准D-d,然后进入第(10)步；(8) 在第(7)步的判断结果为否，则继续判断是否标定行驶速度v 判断结果为是， 则输入驶速度v的监测值和实际值，并计算系数fV^实际值/监测值，然后进入第(10) 步；
(9) 在第(8)步的判断结果为否，则继续判断是否标定铲刀方向角①？判断结果 为是，则输入铲刀方向角(0的监测值和实际值，并计算偏差Aco-监测值一实际值，然后 进入第(10)步；如果判断结果为不是，则直接进入第(10)步；
(10) 判断参数标定是否完成？如果完成，则返回主程序，未完成，则返回第(1) 步重复进行。
如图7所示，所述的高度调平子程序包括有如下步骤-
(1) 输入高程h,并计算偏差Ah-H—h:
(2) 判断是否为横向测距？判断结果为是，则输入横向距离d,使 Ad=D—d(D指标定的铲刀横向距离基准) Ah=Ah—Adxtan (ai)然后进入第(3)步，如果判断结果为否，则直接进入第(3)步
(3) 判断偏差是否大于容许量？即|Ah|>Sh;判断结果为是，则运行PID控制模 块后进入第(4)步
(4) 输入髙度控制升量和高度控制降量的信息后，返回主程序；
(5) 在第(3)步的判断结果为否，则使高度控制升=0、高度控制降-0后，返回 主程序。
对于基本的调平控制，采用高程传感器15 (接触式角位移传感器或非接触式超声波 距离传感器16)监测铲刀9P1点的高度变化，反馈信号进入高度反馈控制程序，经与高 程修正值(如果存在)复合、与标定值比较进入PID模块，输出参量再经运动模块调制， 形成高程电控阀的控制信号，控制铲刀9右侧的升降，使其始终跟踪道路基准并减少平 地机行驶中横向移动的偏差。
如图8所示，所述的角度调平子程序包括有如下步骤 (l)判断控制模式A-O 判断结果为是，则调入控制角度a,并釆集实时数据铲 刀倾斜角0、铲刀回转角P和机架倾斜角(D,然后进入数学模式O进行计算，然后进入第 (4)步；
数学模式0的计算公式是
kl = tan(P) k2 = tan(P).tan((j)) + tan(a) = asin<formula>formula see original document page 16</formula>
(2)在第(1)步的判断结果为A邦时，则继续判断控制模式A-1 判断结果为是，则调入道路数据ai、 si,并采集实时数据铲刀倾斜角e、铲刀回转角p、机架倾斜角O和行驶速度v,然后进入数学模式1进行计算，然后进入第(4)步
数学模式1的计算公式是:<formula>formula see original document page 17</formula>(3)在第(2)步的判断是控制模式A#时，则继续判断控制模式A-2 判断结果 为是，则调入道路数据od、 si、 yi,并采集实时数据铲刀倾斜角e、铲刀方向角co和行 驶速度v，然后进入数学模式2;当A^2时，直接进入第(4)步数学模式2的计算公式是<formula>formula see original document page 17</formula>(4)判断偏差是否大于容许值？即la'—ei〉Sa，判断结果为是，则运行PID控制模块，并输出角度控制升量和角 度控制降量的信息后，返回主程序；(5)在第(4)步的判断结果是偏差不大于容许值时，则输出角度控制升=0、角 度控制降=0后，返回主程序。基本的角度调平控制检测铲刀9水平回转角度P、道路纵向坡度(p，并根据道路设计 的横坡角度a,由控制程序内置数学模型计算出设计要求的斜线坡度a';将斜线坡度a' 与铲刀9实际倾角e进行比较并进入PID模块，输出控制参量并由运动模块调制，形成 角度控制侧电控阀的控制信号，控制铲刀9左侧的升降。这种平地机自动调平的方法可 以满足一般道路工程施工的要求。采用扩展角度调平控制模式，在施工前应将道路施工工程数据通过数据接口输入监 控器，存入其数据存储区在平地机作业过程中，采集输入铲刀9横向移动d、行驶速度 v以及GPS卫星定位经度和纬度坐标值，控制模块a内置的数学模型将GPS卫星定位 经度和纬度坐标值转化为施工道路的坐标数据，即定位P2位置；依据起始点位置，行驶 速度v、铲刀9横向移动d计算确定Pl位置同时从数据存储区调入道路施工工程数据， 由此经过数学模型运算得到当前位置的铲刀9理论坡度ct':将斜线坡度a'与铲刀9实 际倾角e进行比较并进入PID模块，输出控制参量并由运动模块调制，形成高程电控阀 的控制信号，控制铲刀9左侧的升降。这种平地机自动调平方法可以满足各种道路工程 包括弯道超高、道路缓和线等横向坡度变化道路的施工要求。
权利要求
1.一种平地机智能调平控制系统，包括有根据铲刀空间位置监测传感器接收平地机铲刀位置的信号，并自动向控制铲刀油缸的电控液压阀发出控制信号的自动调平电控系统，和接收自动调平电控系统的控制信号驱动铲刀自动调平的自动调平液压系统。
2. 根据权利要求1所述的平地机智能调平控制系统，其特征在于，所述的自动调平 电控系统包括有在平地机上设置的安装在铲刀(9)上部的用于监测铲刀与水平面的 倾斜状态的铲刀倾斜传感器(12);安装在铲刀回转盘(7)上的用于监测铲刀回转角度 的铲刀回转传感器(13);安装在平地机前机架(8)上的用于监测行驶的纵向坡度的机 架倾斜传感器(14);控制铲刀油缸的且设置在自动调平液压系统中的左升降油缸电控阏(4a)和右升降油缸电控阀(4);安装在铲刀(9) 一側的用于跟踪作业路面基准的 铲刀髙程传感器(15)和铲刀距离传感器(16):以及根据接收各传感器信号向左升降 油缸电控阀(4a)和右升降油缸电控阀(4)发出控制信号的调平控制器(10〉和监控显 示器(11),其中，调平控制器(10)分别与铲刀倾斜传感器(12)、铲刀回转传感器 (13)、机架倾斜传感器(14)、左升降油缸电控阀(4a)和右升降油缸电控阀(4)、 铲刀高程传感器(15〉、铲刀距离传感器(16)以及监控显示器(11)相连接。
3. 根据权利要求2所述的平地机智能调平控制系统，其特征在于在平地机上还安 装有与调平控制器(10)相连的整机行驶速度传感器(17)。
4. 根据权利要求2所述的平地机智能调平控制系统，其特征在于在铲刀(9)的 —侧或中部还安装有与调平控制器(10)相连的带差分GPS卫星定位装置(18)。
5. 根据权利要求1所述的平地机智能调平控制系统，其特征在于，所述的自动调平 液压系统包括有控制液体流入的优先阀(6);分别与优先阀(6)的输出端相连的第 —、第二调速节流阀(5a、 5);分别对应连接在两个调速节流闽(5a、 5)的输出端上 且受自动调平电控系统中调平控制器(10)控制的左升降油缸电控阀(4a)和右升降油 缸电控阀(4):分别与优先阀(6〉的输出端相连的第一、第二手动控制阀(la、 1); 与左升降油缸电控阀(4a)和第一手动控制阀(la)相连的第一双向液压锁(2a)及与 右升降油缸电控阀(4)和第二手动控制阀(1)相连的第二双向液压锁(2);以及分别 对应与两个双向液压锁(2a、 2)的输出端相连，驱动铲刀(9)动作的左升降油缸(3a) 和右升降油缸(3);上述的部件之间是通过液压管路相连接的。
6. —种平地机智能调平控制系统的控制方法，其特征在于，包括有如下阶段 第一阶段初始化阶段第二阶段判断是否进行参数设置的阶段是，则调用参数设置子程序，然后返回 主辦；第三阶段在第二阶段中判断不进行参数设置时，继续判断是否进行参数标定？是， 则调用参数标定子程序，然后返回主程序，否则直接返回主程序 第四阶段判断是否进行自动调平阶段第五阶段在第四阶段中判断结果为是，则继续判断是否进行手动微调的阶段； 第六阶段在第五阶段中判断结果为是，则进入手动微调的调整阶段，然后进入第 十三阶段第七阶段在第五阶段中判断结果不进行手动微调，则进入高度调平子程序的阶段;第八阶段执行髙度调平子程序结束后，返回主程序后进入角度调平子程序的阶段:第九阶段:执行角度调平子程序结束后，返回主程序后，判断控制模式是否为M=0 第十阶段在第九阶段中判断结果是M-O,设定其左升阀为髙度调平升，左降阀为 高度调平降设定其右升阈为角度调平升，右降阀为角度调平降，然后进入第十三阶段;第十一阶段在第九阶段中判断结果是MtK),设定其右升阀为髙度调平升，右降阀 为高度调平降；设定其左升阀为角度调平升，右降阀为角度调平降，然后进入第十三阶 段；第十二阶段在第四阶段中判断结果不是进行自动调平，则设定左、右升降阀都为 零，然后进入第十三阶段；第十三阶段将调制的控制信号输出至升降油缸电控阀(4a、 4)，然后结束一个控 制循环周期。
7. 根据权利要求6所述的平地机智能调平控制系统的控制方法，其特征在于，所述的参数设置子程序包括有如下步骤(1) 输入控制模式M=0、 M=l;(2) 判断控制模式是否为M-0 是，则将左升降阀设定为高度控制阀，右升降阀设 定为角度控制阀，否则，将右升降阀设定为高度控制阀，左升降阀设定为角度控制阀；(3) 输入角度模式A=0、 A=l、 A=2:(4) 判断控制模式是否为A=0 (5) 当控制模式为A-O时，输入控制角度a后进入第(11)步；(6) 当控制模式为A^)时，继续判断控制模式是否为A-1 (7) 当控制模式为A4时，输入道路数ai、 si后进入第(11)步；(8) 当控制模式为A^1时，继续判断控制模式是否为A=2 (9) 当控制模式为A^2时，输入道路数ai、 si、 yi后进入第(11)步；(10) 当控制模式为A^2时，直接进入第(11)步；(11) 判断参数设置是否完毕？未完，则返回第(1)步继续设置，是设置完毕则返 回主程序。
8. 根据权利要求6所述的平地机智能调平控制系统的控制方法，其特征在于，所述 的参数标定子程序包括有如下步骤(1) 判断是否进行高度标定？(2) 在第(1)步的判断为是，则继续判断控制模式是否为M=0 当判断结果为M邦 时，进入第(4)步； (3) 在第(2)步的判断是M=0时，则将左控制阀设为高度控制阀，并设置控制 高度H-当前左高度；否则，将右控制阀设为高度控制阀，并设置控制高度H-当前右 高度(4) 判断是否标定机架倾斜角<!> 判断结果为是，则输入机架倾斜角0的监测值和 实际值，并计算偏差AO-监测值一实际值，然后进入第(10)步；(5) 在第(4)步的判断结果为否，则继续判断是否标定铲刀倾斜角e 是，则输入 铲刀倾斜角e的监测值和实际值，并计算偏差厶6=监测值一实际值，后进入第(10)步；(6) 在第(5)步的判断结果为否，则继续判断是否标定铲刀回转角P 判断结果为 是，则输入铲刀(9)回转角p的监测值和实际值，并计算偏差Ap-监测值一实际值， 后进入第(10)步；(7) 在第(6)步的判断结果为否，则继续判断是否标定铲刀距离d 判断结果为是， 则检测当前铲刀距离d，并设定横向距离基准0=(1,然后进入第(10)步；(8) 在第(7)步的判断结果为否，则继续判断是否标定行驶速度v 判断结果为是， 则输入驶速度v的监测值和实际值，并计算系数—实际值/监测值，然后进入第(10) 步；(9) 在第(8)步的判断结果为否，则继续判断是否标定铲刀方向角G) 判断结果 为是，则输入铲刀方向角co的监测值和实际值，并计算偏差Ao)-监测值一实际值，然后 进入第(10)步；如果判断结果为不是，则直接进入第(10)步；(10) 判断参数标定是否完成？如果完成，则返回主程序，未完成，则返回第(1) 步重复进行。
9. 根据权利要求6所述的平地机智能调平控制系统的控制方法，其特征在于，所述 的高度调平子程序包括有如下步骤(1) 输入高程h,并计算偏差Ah-H—h;(2) 判断是否为横向测距？判断结果为是，则输入横向距离d,使 Ad=D—dAh=Ah—Adxtan (ai)然后进入第(3)步，如果判断结果为否，则直接进入第(3)步；(3) 判断偏差是否大于容许量？ B卩|Ah|>Sh;判断结果为是，则运行PID控制模 块后进入第(4)步；(4) 输入高度控制升量和高度控制降量的信息后，返回主程序；(5) 在第(3)步的判断结果为否，则使高度控制升=0、高度控制降=0后，返回主程序。
10. 根据权利要求6所述的平地机智能调平控制系统的控制方法，其特征在于，所 述的角度调平子程序包括有如下步骤(l)判断控制模式A-O 判断结果为是，则调入控制角度a,并采集实时数据铲 刀倾斜角e、铲刀回转角p和机架倾斜角o,然后进入数学模式o进行计算，然后进入第(4)步(2) 在第(1)步的判断结果为A邦时，则继续判断控制模式A-1 判断结果为是， 则调入道路数据d、 si,并采集实时数据铲刀倾斜角e、铲刀回转角p、机架倾斜角①和行驶速度V,然后进入数学模式1进行计算，然后进入第(4)步；(3) 在第(2)步的判断是控制模式A^时，则继续判断控制模式A=2 判断结果 为是，则调入道路数据ai、 si、 yi,并采集实时数据铲刀倾斜角0、铲刀方向角o)和行 驶速度v,然后进入数学模式2:当A^2时，直接进入第(4)步；(4) 判断偏差是否大于容许值？即la'—ei〉Sa,判断结果为是，则运行PID控制模 块，并输出角度控制升量和角度控制降量的信息后，返回主程序；(5) 在第(4)步的判断结果是偏差不大于容许值时，则输出角度控制升=0、角 度控制降-0后，返回主程序。
全文摘要
一种平地机智能调平系统及其调平方法，其系统根据铲刀空间位置监测传感器接收平地机铲刀位置的信号，并自动向控制铲刀油缸的电控液压阀发出控制信号的自动调平电控系统，和接收自动调平电控系统的控制信号驱动铲刀自动调平的自动调平液压系统。方法有初始化判断是否进行参数设置；调用参数设置子程序；判断是否进行参数标定；调用参数标定子程序；判断是否进行自动调平；判断是否进行手动微调；是进入手动微调；否，进入高度调平子程序和进入角度调平子程序；判断控制模式是否为M＝0；调制左、右控制阀的控制信号阶段；将调制的控制信号输出至升降油缸电控阀。本发明适应普通道路横坡、弯道超高、道路缓和线等横向坡度按一定规律变化的精确控制。
文档编号G05D3/12GK101117809SQ20071005950
公开日2008年2月6日 申请日期2007年9月5日 优先权日2007年9月5日
发明者吴卫国, 吴国祥, 李玉河 申请人:天津工程机械研究院