4. 执行机构控制逻辑基础
矿山钻锚机器人的执行机构——回转马达、推进油缸、夹钎器、支腿、锚杆仓摆动缸等——最终都要落到四类最基本的控制方式上:开关量控制决定“动不动”,方向控制决定“往哪动”,速度控制决定“动多快”,压力控制决定“用多大力”。这四类控制层层叠加,构成了整机液压与电气控制逻辑的骨架。理解它们各自的回路构成和逻辑表达方式,是读懂后续章节中自动钻孔、自动装锚等复合动作程序的前提。
一、开关量控制:最基础的“通断”逻辑
开关量控制只有两个稳定状态:得电/失电、通/断、开/关。在钻锚机器人上,它通常由PLC数字量输出驱动电磁换向阀的电磁铁,或直接驱动接触器、继电器。典型对象包括:泵站电机启停、冷却风扇启停、夹钎器夹紧/松开、锚杆仓旋转定位、警示灯与蜂鸣器。
逻辑表达上,开关量控制最适合用布尔代数描述。例如夹钎器夹紧的条件可写为:Clamp = AutoMode AND HoleReady AND NOT Fault。工程上还要加入互锁:夹钎器松开与回转马达启动互锁,防止钎杆在未夹紧时旋转甩出。实际编程时,一个开关量输出往往不是单一条件,而是“启动条件 OR 自保持”再“AND NOT 停止条件”的标准起保停结构,这是PLC梯形图里最常见的开关量逻辑表达形式。
需要注意的是,开关量控制虽然简单,但电磁阀从得电到阀芯完全换向存在几十毫秒的响应时间,多个开关量动作若有严格先后顺序,必须靠程序延时或位置传感器反馈来保证,不能仅靠“同时输出”。
二、方向控制:换向阀与中位机能
方向控制的核心元件是方向控制阀,钻锚机器人上以三位四通电磁换向阀为主。以推进油缸为例:电磁铁YA1得电,压力油进入无杆腔,活塞杆伸出(推进);YA2得电,压力油进入有杆腔,活塞杆缩回(提钻);两电磁铁均失电时阀芯回到中位,此时中位机能决定油缸两腔的状态。
中位机能的选择直接关系到安全与效率。推进回路常选O型中位(各油口全封闭),使油缸在断电时保持位置,防止钻具因自重下滑;但O型中位在换向瞬间易产生液压冲击。若选用Y型中位(A、B口通回油),油缸两腔卸荷,活塞可在外力下浮动,适合需要手动对孔或让钻具随导轨自由贴合的场合。因此方向控制不只是“选通哪一路”,还包括“不通时处于什么状态”的逻辑设计。
方向控制的逻辑表达可用状态表描述:输入为YA1、YA2的得电组合,输出为油缸运动方向。这种“输入组合—输出状态”的映射,正是后续用状态机描述自动钻孔流程的基础。
三、速度控制:流量决定快慢
液压执行元件的速度由进入其的流量决定。钻锚机器人常用的速度控制方式有三种:节流调速(在回路中串入节流阀或调速阀)、容积调速(改变变量泵排量或变量马达排量)、以及比例阀连续调速。
以推进油缸的进给速度为例,若采用回油节流调速,节流阀装在回油路上,能形成背压,使进给运动更平稳,适合钻凿时抵抗冲击。设油缸无杆腔面积A₁、有杆腔面积A₂,节流阀流量为q,则活塞伸出速度v≈q/A₂(回油节流时按回油流量折算)。实际选型时,若要求快进速度0.3 m/s、工进速度0.02 m/s,可采用差动快进加回油节流的组合回路,用换向阀切换实现速度换接。
速度控制的逻辑表达通常写成“工况—阀状态—目标速度”的对应关系。例如:空行程推进用大流量泵全排量,接近孔底时切换到工进,比例阀给定电流从800 mA降到200 mA,速度随之下降。这里的关键是速度切换点必须由位置传感器或压力信号触发,而不是靠固定延时,否则孔深变化时换接点会漂移。
四、压力控制:力与安全的边界
压力控制决定执行机构输出力的大小,同时承担系统安全保护。基本元件包括溢流阀、减压阀、顺序阀和压力继电器。钻锚机器人泵站主回路上必设溢流阀,限定系统最高压力,例如设定为21 MPa;推进回路则常加装减压阀,把推进压力限制在较低值(如8 MPa),避免钻杆弯曲或卡钻时损坏钻具。
压力控制还用于逻辑判断。压力继电器或压力传感器可检测“夹钎器是否已夹紧到位”“钻杆是否已顶到孔底”“是否发生卡钻”。例如当推进压力超过设定阈值并持续2 s,程序判定为卡钻,触发回退与报警。这种“压力阈值+持续时间”的判断,是压力控制从单纯限压走向逻辑控制的关键。
压力与速度并非独立:在定量泵系统中,负载压力升高会使溢流阀开启量增大,实际进入执行元件的流量减少,速度下降。因此调试时若发现工进速度随孔深增加而变慢,应检查是负载增大还是溢流阀设定偏低,而不是盲目调大节流口。
五、四类控制的叠加与逻辑表达
实际回路中,四类控制是叠加使用的。以“自动推进钻孔”为例:开关量控制决定推进使能与总使能;方向控制选定推进油缸伸出;速度控制通过比例阀把进给速度从快进切到工进;压力控制则监视推进压力,超限即判定卡钻并触发回退。四者共同构成一个带反馈的闭环逻辑。
逻辑表达上,建议采用“条件—动作—反馈”三段式描述每个动作单元。例如:
动作:推进工进
条件:AutoMode=1 AND HoleReady=1 AND Pos > 快进终点
动作:YA1=1, 比例阀给定=200 mA, 减压阀设定=8 MPa
反馈:推进压力 > 12 MPa 持续 2 s → 判定卡钻 → YA1=0, YA2=1 回退
这种写法把开关量、方向、速度、压力四类信息统一在一个动作单元里,既便于编程,也便于现场调试时逐项核对。调试时可按“先手动单动作验证方向与限压,再验证速度切换点,最后联调自动逻辑”的顺序推进,避免多因素耦合导致排障困难。
掌握这四类基本回路及其逻辑表达,就具备了把“钻锚机器人要做什么”翻译成“阀和电磁铁该怎么动作”的能力。后续的自动钻孔循环、锚杆安装时序,本质上都是这些基本单元按工艺顺序的组合与互锁。