CN112746812A - 凿岩台车照明摄像随动***、控制方法及凿岩台车 - Google Patents
凿岩台车照明摄像随动***、控制方法及凿岩台车 Download PDFInfo
- Publication number
- CN112746812A CN112746812A CN202110093627.6A CN202110093627A CN112746812A CN 112746812 A CN112746812 A CN 112746812A CN 202110093627 A CN202110093627 A CN 202110093627A CN 112746812 A CN112746812 A CN 112746812A
- Authority
- CN
- China
- Prior art keywords
- rock drilling
- coordinate system
- detection module
- determining
- local coordinate
- 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.)
- Pending
Links
- 238000005286 illumination Methods 0.000 title claims abstract description 48
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000005553 drilling Methods 0.000 claims abstract description 159
- 239000011435 rock Substances 0.000 claims abstract description 159
- 230000033001 locomotion Effects 0.000 claims abstract description 12
- 238000011426 transformation method Methods 0.000 claims abstract description 7
- 238000001514 detection method Methods 0.000 claims description 79
- 239000011159 matrix material Substances 0.000 claims description 46
- 230000009466 transformation Effects 0.000 claims description 41
- 238000003384 imaging method Methods 0.000 claims description 5
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 abstract description 7
- 238000010586 diagram Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 238000011179 visual inspection Methods 0.000 description 1
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B7/00—Special methods or apparatus for drilling
- E21B7/02—Drilling rigs characterised by means for land transport with their own drive, e.g. skid mounting or wheel mounting
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B15/00—Supports for the drilling machine, e.g. derricks or masts
- E21B15/003—Supports for the drilling machine, e.g. derricks or masts adapted to be moved on their substructure, e.g. with skidding means; adapted to drill a plurality of wells
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21B—EARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
- E21B41/00—Equipment or details not covered by groups E21B15/00 - E21B40/00
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04N—PICTORIAL COMMUNICATION, e.g. TELEVISION
- H04N23/00—Cameras or camera modules comprising electronic image sensors; Control thereof
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04N—PICTORIAL COMMUNICATION, e.g. TELEVISION
- H04N23/00—Cameras or camera modules comprising electronic image sensors; Control thereof
- H04N23/60—Control of cameras or camera modules
- H04N23/66—Remote control of cameras or camera parts, e.g. by remote control devices
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04N—PICTORIAL COMMUNICATION, e.g. TELEVISION
- H04N23/00—Cameras or camera modules comprising electronic image sensors; Control thereof
- H04N23/60—Control of cameras or camera modules
- H04N23/695—Control of camera direction for changing a field of view, e.g. pan, tilt or based on tracking of objects
Landscapes
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mining & Mineral Resources (AREA)
- Geology (AREA)
- Fluid Mechanics (AREA)
- Environmental & Geological Engineering (AREA)
- Physics & Mathematics (AREA)
- Signal Processing (AREA)
- Multimedia (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geochemistry & Mineralogy (AREA)
- Mechanical Engineering (AREA)
- Earth Drilling (AREA)
Abstract
本发明公开了一种凿岩台车照明摄像随动***、控制方法及凿岩台车,属于工程机械控制领域。包括车架、设置在车架上的凿岩工作组件、云台和控制装置,云台上的设置有照明摄像装置、凿岩工作组件设置有凿岩机;凿岩工作组件包括依次连接的第一构件、第二构件、第三构件、第四构件、第五构件、第六构件和第七构件;凿岩机设置在第七构件上;控制装置与云台连接。通过实时获取凿岩工作组件的各构件的空间运动信息,利用空间变换方法,实时获取凿岩机的凿岩端的空间位置,然后计算照明摄像装置的调整角度,控制云台动作实现照明摄像装置与凿岩机的凿岩端随动,照明摄像效果好,有效降低了操作人员的工作负担,提高了作业效率。
Description
技术领域
本发明属于工程机械控制领域,具体涉及一种凿岩台车照明摄像随动***、控制方法及凿岩台车。
背景技术
凿岩台车(以下简称“车辆”)的凿岩装置安装在车辆大臂前侧,其在地下工作面工作时,需要大臂移动,使凿岩装置到达工作点,然后接通动力源,进行凿岩作业。由于工作点距离车辆较远,且地下光线昏暗,需要车辆前侧安装工作照明装置,使车辆凿岩工作时,工作点获得充分的光照,操作者可在车辆附近观测到凿岩装置工作情况,此外为了能够对凿岩情况进行监控,还会在车辆前侧安装摄像机,从而实施对凿岩情况进行拍摄监控。
目前,凿岩台车在作业过程中,当某个工作点凿岩结束后,需要移动大臂至另一工作点,如果新工作点和原有工作点距离较远,则操作者需要挪动照明装置以机摄像机的角度,使新工作点得到充分的光线,并且能够对新工作点进行摄像。当一个工作面的工作点较多时,需要操作者不停的人工扳动调整照明装置及摄像机方向,从而增加了操作人员的负担。此外车辆的大臂较长,操作者距离工作点较远,通过目测不易观察到较远的工作点,使得人为调整照明装置和摄像机的方向时也会不准确,导致照明和摄像的效果不好。因此为了是工作面或工作点获得更理想的光照以及拍摄效果,并能减少操作人员的工作负担,是目前凿岩台车技术领域需要解决的问题。
发明内容
技术问题:本发明针对目前凿岩台车在作业时,需要人为调整照明和摄像装置的方向,导致照明摄像效果不佳以及极大增加操作人员的工作负担的问题,本发明提供一种岩台车照明摄像随动***及相应的控制方法,提高照明和摄像的效果,并有效地减少操作人员的工作负担;进一步地,提供一种凿岩台车。
技术方案:本发明的凿岩台车照明摄像随动***,包括车架、设置在车架上的凿岩工作组件、云台和控制装置,所述云台上的设置有照明摄像装置、所述凿岩工作组件设置有凿岩机;
所述凿岩工作组件包括依次连接的第一构件、第二构件、第三构件、第四构件、第五构件、第六构件和第七构件,其中,第一构件铰接在车架上,第二构件与第一构件铰接,第三构件与第二构件滑动套接,第四构件与第三构件铰接,第五构件与第四构件铰接,第六构件与第五构件转动连接,第七构件铰接在第六构件上;
所述凿岩机设置在第七构件上;
所述控制装置与云台连接,通过实时获取凿岩工作组件的各构件的空间运动信息,控制云台动作实现照明摄像装置与凿岩机的凿岩端随动。
进一步地,所述第六构件与第五构件的轴线垂直。
进一步地,所述控制装置包括:
第一角度检测模块,用于检测第一构件的旋转角度;
第二角度检测模块,用于检测第二构件的旋转角度;
第三角度检测模块,用于检测第四构件的旋转角度;
第四角度检测模块,用于检测第五构件的旋转角度;
第五角度检测模块,用于检测第六构件的旋转角度;
第六角度检测模块,用于检测第七构件的旋转角度;
第一长度检测模块,用于检测凿岩机的凿岩端的伸长距离;
第二长度检测模块,用于检测第三构件的伸长距离;
控制器,用于根据各检测模块发送来的信息进行运算,并向云台发送控制指令,通过云台驱动照明摄像装置运动。
进一步地,所述第一角度检测模块、第二角度检测模块、第三角度检测模块、第四角度检测模块、第五角度检测模块、第五角度检测模块均为编码器。
进一步地,所述第一长度检测模块和第二长度检测模块均为拉绳位移传感器。
本发明的凿岩台车照明摄像随动控制方法,包括:
第一角度检测模块检测检测第一构件的旋转角度,第二角度检测模块检测检测第二构件的旋转角度,第三角度检测模块检测第四构件的旋转角度,第四角度检测模块检测第五构件的旋转角度,第五角度检测模块检测第六构件的旋转角度;第六角度检测模块检测第七构件的旋转角度,第一长度检测模块检测凿岩机的凿岩端的伸长距离,第二长度检测模块检测第三构件的伸长距离;
控制器根据各检测模块所检测的数据,计算凿岩机的凿岩端的空间位置,根据凿岩端的空间位置计算照明摄像装置的运动角度;
控制器根据照明摄像装置的运动角度,向云台发送控制指令,控制云台驱动照明摄像装置与凿岩机的凿岩端随动。
进一步地,计算凿岩机的凿岩端的空间位置的方法为:
以照明摄像装置的安装点J0为坐标原点,构建全局坐标系Coord0;
以第一构件与车架的连接点J1为坐标原点,构建第一局部坐标系Coord1,所述第一局部坐标系Coord1固定在第一构件上;
以第一构件和第二构件的连接点J2为坐标原点,构建第二局部坐标系Coord2,所述第二局部坐标系Coord2固定在第二构件上;
以第三构件与第四构件连接的一端的端点J3为坐标原点,构建第三局部坐标系Coord3,所述第三局部坐标系Coord3固定在第三构件上;
以第三构件和第四构件的连接点J4为坐标原点,构建第四局部坐标系Coord4,所述第四局部坐标系Coord4固定在第四构件上;
以第四构件和第五构件的连接点J5为坐标原点,构建第五局部坐标系Coord5,所述第五局部坐标系Coord5固定在第五构件上;
以第五构件与第六构件的连接点J6为坐标原点,构建第六局部坐标系Coord6,所述第六局部坐标系Coord6固定在第六构件上;
以第六构件与第七构件的连接点J7为坐标原点,构建第七局部坐标系Coord7,所述第七局部坐标系Coord7固定在第七构件上;
根据所构建的坐标系Coord0、Coord1、Coord2、Coord3、Coord4、Coord5、Coord6、Coord7,利用空间变换方法,计算凿岩机的凿岩端的在全局坐标系下的空间坐标;
根据凿岩机的凿岩端的在全局坐标系下的空间坐标确定照明摄像装置的调整角度。
进一步地,利用空间变换方法,计算凿岩机的凿岩端的初始位置在全局坐标系下的空间坐标的方法为:
确定凿岩机的凿岩端在第七局部坐标系Coord7下的初始位置的齐次坐标P0,根据凿岩机的凿岩端的伸长距离,计算第一平移变换矩阵H1,得到变换后凿岩端的齐次坐标P1,其中,P1=H1×P0;
获取的第七构件绕第六局部坐标系Coord6的Y6轴的旋转角度θ1,计算第一旋转变换矩阵R1,确定坐标原点J7在第六局部坐标系Coord6中的齐次坐标PJ6,根据PJ6确定第二平移变换矩阵H2,得到凿岩端初始位置在Coord6中的齐次坐标P2,P2=H2×R1×P1;
获取第六构件绕第五局部坐标系Coord5的X5轴的旋转角度θ2,确定第二旋转变换矩阵R2,确定坐标原点J6在第五局部坐标系Coord5中的齐次坐标PJ5,根据PJ5确定第三平移变换矩阵H3,得到凿岩端初始位置在Coord5中的齐次坐标P3,P3=H3×R2×P2;
获取第五构件绕第四局部坐标系Coord4的Z4轴的旋转角度θ3,确定第三旋转变换矩阵R3,确定坐标原点J5在第四局部坐标系Coord4中的齐次坐标PJ4,根据PJ4确定第四平移变换矩阵H4,得到凿岩端初始位置在Coord4中的齐次坐标P4,P4=H4×R3×P3;
获取第四构件绕第三局部坐标系Coord3的Y3轴的旋转角度θ4,确定第四旋转变换矩阵R4,确定坐标原点J4在第三局部坐标系Coord3中的齐次坐标PJ3,根据PJ3确定第五平移变换矩阵H5,得到凿岩端初始位置在Coord3中的齐次坐标P5,P5=H5×R4×P4;
获取第三构件沿第二局部坐标系Coord2的X2轴方向伸长距离L2,确定第六平移变换矩阵H6,确定坐标原点J3在第二局部坐标系Coord2中的齐次坐标PJ2,根据PJ2确定第七平移变换矩阵H7,得到凿岩端初始位置在Coord2中的齐次坐标P6,P6=H7×H6×P5;
获取第二构件绕第一局部坐标系Coord1的Y1轴的旋转角度θ5,确定第五旋转变换矩阵R5,确定坐标原点J2在第一局部坐标系Coord1中的齐次坐标PJ1,根据PJ1确定第八平移变换矩阵H8,得到凿岩端初始位置在Coord1中的齐次坐标P7,P7=H8×R5×P6;
获取第一构件绕全局坐标系Coord0的Z轴的旋转角度θ6,确定第六旋转变换矩阵R6,确定坐标原点J1在全局坐标系Coord0中的齐次坐标PJ0,根据PJ0确定第九平移变换矩阵H9,得到凿岩端初始位置在Coord0中的齐次坐标P8,P8=H9×R6×P7,即为凿岩端在全局坐标系下的空间坐标。
进一步地,根据凿岩机的凿岩端在全局坐标系下的空间坐标确定照明摄像装置的调整角度的方法为:
将凿岩端在全局坐标系下的空间坐标P8表示为:
P1=[θ,β,γ,1]T
计算照明摄像角度在全局坐标系Coord0的角度相对于X、Y、Z轴的角度分别为θx、θy、θz,则
控制器根据θx、θy、θz的值,通过云台控制照明摄像装置调整角度,实现随动。
本发明的凿岩台车,所述的照明摄像随动控制***,并利用所述照明摄像随动控制方法控制照明摄像装置随动。
有益效果:本发明与现有技术相比,本发明中照明摄像装置能够与凿岩机的凿岩端随动,照明摄像装置的方向能够随着凿岩机的凿岩端进行调整,使得照明方向与摄像方向能够实时对准凿岩机的凿岩端,因此避免了由于操作人员离作业点的距离过远时,不能准确调整照明摄像装置的方向,导致照明摄像效果不理想的问题;同时,照明摄像装置的方向自动调整,无需人工搬动,极大地降低了操作人员的工作负担,提高了作业效率。
附图说明
图1为本发明凿岩台车照明摄像随动***的结构示意图;
图2为图1中A处的局部放大图;
图3为本发明的工作组件的结构图;
图4为本发明的一种实施例中的凿岩机结构图;
图5为照明摄像角度示意图。
图中有:1、车架;2、云台;3、照明摄像装置;4、第一构件;5、第二构件、6、第三构件;7、第四构件;8、第五构件;9、第六构件;10、第七构件;11、凿岩机。
具体实施方式
下面结合实施例和说明书附图对本发明作进一步的说明,其中,术语“第一”、“第二”、“第三”等仅用于描述目的,而不能理解为指示或暗示相对重要性。
结合图1所示,本发明的照明摄像随动***包括车架1、设置在车架1上的凿岩工作组件、云台2和控制装置,云台2上的设置有照明摄像装置3、所述凿岩工作组件设置有凿岩机11。云台2是用于安装、固定支撑照明摄像装置3,可以利用电机来调整照明摄像装置3的水平和俯仰角度,通常照明方向和摄像方向是相同的,所以设置在同一个云台2上,从而实现照明和摄像方向的同步调整。对于云台2、照明摄像装置3机均可以采用现有的,因此,这里就不对其结构做详细说明,照明摄像机可以采用单独的结构照明灯和摄像机,也可以采用带照明灯的摄像机。
结合图1和图2所示,所述凿岩工作组件包括依次连接的第一构件4、第二构件5、第三构件6、第四构件7、第五构件8、第六构件9和第七构件10,其中,第一构件4铰接在车架1上,第二构件5与第一构件4铰接,第三构件6与第二构件5滑动套接,第四构件7与第三构件6铰接,第五构件8与第四构件7铰接,第六构件9与第五构件8转动连接,第七构件10铰接在第六构件9上。通过若干个构件的连接结构,可以实现凿岩过程的多方位作业,各构件在运动时,可以通过液压驱动、或者电机驱动的方式实现平动或转动,均可利用现有的技术完成驱动。
在本发明的实施例中,第六构件9与第五构件8的轴线垂直,便于增大凿岩台车的凿岩工作面。
凿岩机11设置在第七构件10上,当利用凿岩工作组件将凿岩机11调整到凿岩作业点后,进行凿岩,凿岩机11可以采用现有技术中的凿岩机,例如图4所示的凿岩机结构,图4为申请号201910064722.6的专利中凿岩机的结构。
控制模块与云台2连接,通过实时获取凿岩工作组件的各构件的空间运动信息,根据所获信息,控制云台2动作驱动照明摄像装置3的与凿岩机11的凿岩端随动,从而照明摄像装置3的方向能够随着凿岩机11的凿岩端进行调整,使得照明方向与摄像方向能够实时对准凿岩机11的凿岩端,因此避免了由于操作人员离作业点的距离过远时,不能准确调整照明摄像装置3的方向,导致照明摄像效果不理想的问题;同时,照明摄像装置的方向自动调整,无需人工搬动,极大地降低了操作人员的工作负担,提高了作业效率。
为了能够获得凿岩工作组件的各构件以及凿岩机11运动信息,本发明的实施例中,控制装置包括第一角度检测模块,用于检测第一构件4的旋转角度;第二角度检测模块,用于检测第二构件5的旋转角度;第三角度检测模块,用于检测第四构件7的旋转角度;第四角度检测模块,用于检测第五构件8的旋转角度;第五角度检测模块,用于检测第六构件9的旋转角度;第六角度检测模块,用于检测第七构件10的旋转角度;第一长度检测模块,用于检测凿岩机11的凿岩端的伸长距离;第二长度检测模块,用于检测第三构件6的伸长距离;控制器,用于根据各检测模块发送来的信息进行运算,并向云台2发送控制指令,通过云台2驱动照明摄像装置3运动。
具体的,在发明的实施例中,角度检测模块均采用编码器,编码器可以将角位移转换为电信号,并能将电信号进行编制、转换为可用以通讯、传输和存储,从而能够对相应部件的转动角度进行检测。两个长度检测模块采用的是拉绳位移传感器,能够测量相应构件的伸缩变化。控制器可采用PLC,PLC能够根据各检测模块发来的数据,计算凿岩机11的凿岩端的空间位置,然后根据所计算的空间位置,实时计算照明灯和摄像机的俯仰角度,然后向云台2发送控制信号,云台2根据所接收的信号驱动照明摄像装置3运动,实现照明摄像装置与凿岩机11的凿岩端随动。
基于本发明的凿岩台车照明摄像随动***,提出了一种凿岩台车照明摄像随动控制方法,该方法包括第一角度检测模块检测检测第一构件4的旋转角度,第二角度检测模块检测检测第二构件5的旋转角度,第三角度检测模块检测第四构件7的旋转角度,第四角度检测模块检测第五构件8的旋转角度,第五角度检测模块检测第六构件9的旋转角度;第六角度检测模块检测第七构件10的旋转角度,第一长度检测模块检测凿岩机11的凿岩端的伸长距离,第二长度检测模块检测第三构件6的伸长距离;控制器根据各检测模块所检测的数据,计算凿岩机11的凿岩端的空间位置,根据凿岩端的空间位置计算照明摄像装置3的运动角度;控制器根据照明摄像装置3的运动角度,向云台2发送控制指令,控制云台2驱动照明摄像装置3与凿岩机11的凿岩端随动。
为了计算计算凿岩机11的凿岩端的空间位置,首先需要建立空间坐标系,由于凿岩工作组件包括多个运动构件,因此需要建立全局坐标系和各固定在各运动构件上的局部坐标系,然后利用空间变换方法,计算凿岩机11的凿岩端在全局坐标系的空间坐标,即获得凿岩端的空间位置。
建立空间坐标系的方法为:以照明摄像装置3的安装点J0为坐标原点,构建全局坐标系Coord0,全局坐标系Coord0的坐标轴方向如图1中的X、Y、Z方向,在图1中,Y轴垂直纸面。
以第一构件4与车架的连接点J1为坐标原点,构建第一局部坐标系Coord1,第一局部坐标系Coord1固定在第一构件4上,Coord1的坐标轴方向如图3中的X1、Y1、Z1方向。
以第一构件4与第二构件5的连接点J2为坐标原点,构建第二局部坐标系Coord2,第二局部坐标系Coord2固定在第二构件5上,Coord2的坐标轴方向如图3中的X2、Y2、Z2方向。
以第三构件6与第四构件7连接一端的端点J3为坐标原点,构建第三局部坐标系Coord3,第三局部坐标系Coord3固定在第三构件6上,Coord3的坐标轴方向如图3中的X3、Y3、Z3方向。
以第三构件6与第四构件7的连接点J4为坐标原点,构建第四局部坐标系Coord4,第四局部坐标系Coord4固定在第四构件7上,Coord4的坐标轴方向如图3中的X4、Y4、Z4方向。
以第四构件7与第五构件8的连接点J5为坐标原点,构建第五局部坐标系Coord5,第五局部坐标系Coord5固定在第五构件8上,Coord5的坐标轴方向如图3中的X5、Y5、Z5方向。
以第五构件8与第六构件9的连接点J6为坐标原点,构建第六局部坐标系Coord6,第六局部坐标系Coord6固定在第六构件9上,Coord6的坐标轴方向如图3中的X6、Y6、Z6方向。
以第六构件9与第七构件10的连接点J7为坐标原点,构建第七局部坐标系Coord7,第七局部坐标系Coord7固定在第七构件10上,Coord7的坐标轴方向如图3中的X7、Y7、Z7方向。
根据所构建的坐标系Coord0、Coord1、Coord2、Coord3、Coord4、Coord5、Coord6、Coord7,利用空间变换方法,即可计算出凿岩机11的凿岩端的在全局坐标系Coord0下的空间坐标。具体的计算方法为:
确定凿岩机11的凿岩端在第七局部坐标系Coord7下的初始位置的齐次坐标P0=[X7,Y7,Z7,1]T,根据第一长度检测模块获得的凿岩端沿Coord7的X7轴的伸长距离L1,计算第一平移变换矩阵H1,第一平移变换矩阵H1为:
得到变换后凿岩端的齐次坐标P1,其中,P1=H1×P0。
根据第六角度检测模块获取的第七构件10绕第六局部坐标系Coord6的Y6轴的旋转角度θ1,计算第一旋转变换矩阵R1为:
其中C表示cos(()余弦函数,S表示sin()正弦函数。
确定坐标原点J7在第六局部坐标系Coord6中的齐次坐标PJ6=[X6,Y6,Z6,1]T,因为第六构件9的长度是确定的,因此可以直接获得PJ6,其中,在本发明的实施例中,可知X6和Z6均为0,Y6为J6到J7的距离。根据PJ6确定第二平移变换矩阵H2为:
并计算得到凿岩端初始位置在Coord6中的齐次坐标P2为:
P2=H2×R1×P1=H2×R1×H1×P0
利用第五角度传感器获取第六构件9绕第五局部坐标系Coord5的X5轴的旋转角度θ2,确定第二旋转变换矩阵R2为:
确定坐标原点J6在第五局部坐标系Coord5中的齐次坐标PJ5=[X5,Y5,Z5,1]T,其中,在本发明的实施例中Y5、Z5均为0,X5为J5到J6的距离。根据PJ5确定第三平移变换矩阵H3为:
计算得到凿岩端初始位置在Coord5中的齐次坐标P3:
P3=H3×R2×P2=H3×R2×H2×R1×H1×P0。
利用第四角度检测模块获取第五构件8绕第四局部坐标系Coord4的Z4轴的旋转角度θ3,确定第三旋转变换矩阵R3为:
确定坐标原点J5在第四局部坐标系Coord4中的齐次坐标PJ4=[X4,Y4,Z4,1]T,其中,在本发明的实施例中Y4、Z4均为0,X4为J4到J5的距离。根据PJ4确定第四平移变换矩阵H4为:
计算得到凿岩端初始位置在Coord4中的齐次坐标P4,
P4=H4×R3×P3=H4×R3×H3×R2×H2×R1×H1×P0
利用第三角度检测模块获取第四构件7绕第三局部坐标系Coord3的Y3轴的旋转角度θ4,确定第四旋转变换矩阵R4为:
确定坐标原点J4在第三局部坐标系Coord3中的齐次坐标PJ3=[X3,Y3,Z3,1]T,其中,在本发明的实施例中,Y3、Z3均为0,X3为J3到J4的距离。根据PJ3确定第五平移变换矩阵H5为:
计算得到凿岩端初始位置在Coord3中的齐次坐标P5:
P5=H5×R4×P4=H5×R4×H4×R3×H3×R2×H2×R1×H1×P0
利用第二长度检测模块获取第三构件6沿第二局部坐标系Coord2的X2轴方向伸长距离L2,确定第六平移变换矩阵H6为:
确定坐标原点J3在第二局部坐标系Coord2中的齐次坐标PJ2=[X2,Y2,Z2,1]T,在本发明的实施例中,Y2、Z2均为0,X2为J2到J3的距离。根据PJ2确定第七平移变换矩阵H7为:
计算得到凿岩端初始位置在Coord2中的齐次坐标P6:
P6=H7×H6×P5=H7×H6×H5×R4×H4×R3×H3×R2×H2×R1×H1×P0
利用第二角度检测模块获取第二构件5绕第一局部坐标系Coord1的Y1轴的旋转角度θ5,确定第五旋转变换矩阵R5为:
确定坐标原点J2在第一局部坐标系Coord1中的齐次坐标PJ1=[X1,Y1,Z1,1]T,在本发明的实施例中,Y1、Z1均为0,X1为J1到J2的距离。根据PJ1确定第八平移变换矩阵H8为:
计算得到凿岩端初始位置在Coord1中的齐次坐标P7:
P7=H8×R5×P6
=H8×R5×H7×H6×H5×R4×H4×R3×H3×R2×H2×R1×H1×P0
利用第一角度检测获取第一构件4绕全局坐标系Coord0的Z轴的旋转角度θ6,确定第六旋转变换矩阵R6为:
确定坐标原点J1在全局坐标系Coord0中的齐次坐标PJ0=[X0,Y0,Z0,1]T,即J1点在全局坐标系下的坐标。根据PJ0确定第九平移变换矩阵H9为:
计算得到凿岩端初始位置在Coord0中的齐次坐标P8:
P8=H9×R6×P7
=H8×R5×H7×H6×H5×R4×H4×R3×H3×R2×H2×R1×H1×P0
根据P8来计算照明摄像的角度,具体的,将凿岩端在全局坐标系下的空间坐标P8表示为:
P8=[α,β,γ1]T
如图5所示,照明摄像角度在全局坐标系Coord0的角度相对于X、Y、Z轴的角度分别为θx、θy、θz,则:
利用上述方法,PLC实时计算得到照明摄像装置3的调整角度,然后向云台2发送控制信号,云台2驱动照明摄像装置3运动,使得照明和摄像方向实时对准凿岩机11的凿岩端,实现了照明和摄像的随动。无需人工进行角度调整,使得照明和摄像效果好,并且极大降低了操作人员的负担,自动化程度高,提高了凿岩台车作业效率。
进一步地,提供了一种凿岩台车,该凿岩台车采用了所提出的照明摄像随动***,并利用所提出的控制方法进行随动控制,从而使得操作人员在驾驶凿岩台车作业时,能够更好地对作业面或作业点进行照明和摄像,较少了操作人员的工作负担,提高了凿岩作业效率。
上述实施例仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和等同替换,这些对本发明权利要求进行改进和等同替换后的技术方案,均落入本发明的保护范围。
Claims (10)
1.一种凿岩台车照明摄像随动***,其特征在于,包括车架(1)、设置在车架(1)上的凿岩工作组件、云台(2)和控制装置,所述云台(2)上的设置有照明摄像装置(3)、所述凿岩工作组件设置有凿岩机(11);
所述凿岩工作组件包括依次连接的第一构件(4)、第二构件(5)、第三构件(6)、第四构件(7)、第五构件(8)、第六构件(9)和第七构件(10),其中,第一构件(4)铰接在车架(1)上,第二构件(5)与第一构件(4)铰接,第三构件(6)与第二构件(5)滑动套接,第四构件(7)与第三构件(6)铰接,第五构件(8)与第四构件(7)铰接,第六构件(9)与第五构件(8)转动连接,第七构件(10)铰接在第六构件(9)上;
所述凿岩机(11)设置在第七构件(10)上;
所述控制装置与云台(2)连接,通过实时获取凿岩工作组件的各构件的空间运动信息,控制云台(2)动作实现照明摄像装置(3)与凿岩机(11)的凿岩端随动。
2.根据权利要求1所述的凿岩台车照明摄像随动***,其特征在于,所述第六构件(9)与第五构件(8)的轴线垂直。
3.根据权利要求1所述的凿岩台车照明摄像随动***,其特征在于,所述控制装置包括:
第一角度检测模块,用于检测第一构件(4)的旋转角度;
第二角度检测模块,用于检测第二构件(5)的旋转角度;
第三角度检测模块,用于检测第四构件(7)的旋转角度;
第四角度检测模块,用于检测第五构件(8)的旋转角度;
第五角度检测模块,用于检测第六构件(9)的旋转角度;
第六角度检测模块,用于检测第七构件(10)的旋转角度;
第一长度检测模块,用于检测凿岩机(11)的凿岩端的伸长距离;
第二长度检测模块,用于检测第三构件(6)的伸长距离;
控制器,用于根据各检测模块发送来的信息进行运算,并向云台(2)发送控制指令,通过云台(2)驱动照明摄像装置(3)运动。
4.根据权利要求3所述的凿岩台车照明摄像随动***,其特征在于,所述第一角度检测模块、第二角度检测模块、第三角度检测模块、第四角度检测模块、第五角度检测模块、第五角度检测模块均为编码器。
5.根据权利要求3或4所述的凿岩台车照明摄像随动***,其特征在于,所述第一长度检测模块和第二长度检测模块均为拉绳位移传感器。
6.一种凿岩台车照明摄像随动控制方法,其特征在于,包括:
第一角度检测模块检测检测第一构件(4)的旋转角度,第二角度检测模块检测检测第二构件(5)的旋转角度,第三角度检测模块检测第四构件(7)的旋转角度,第四角度检测模块检测第五构件(8)的旋转角度,第五角度检测模块检测第六构件(9)的旋转角度;第六角度检测模块检测第七构件(10)的旋转角度,第一长度检测模块检测凿岩机(11)的凿岩端的伸长距离,第二长度检测模块检测第三构件(6)的伸长距离;
控制器根据各检测模块所检测的数据,计算凿岩机(11)的凿岩端的空间位置,根据凿岩端的空间位置计算照明摄像装置(3)的运动角度;
控制器根据照明摄像装置(3)的运动角度,向云台(2)发送控制指令,控制云台(2)驱动照明摄像装置(3)与凿岩机(11)的凿岩端随动。
7.根据权利要求6所述的凿岩台车照明摄像随动控制方法,其特征在于,计算凿岩机(11)的凿岩端的空间位置的方法为:
以照明摄像装置(3)的安装点J0为坐标原点,构建全局坐标系Coord0;
以第一构件(4)与车架(1)的连接点J1为坐标原点,构建第一局部坐标系Coord1,所述第一局部坐标系Coord1固定在第一构件(4)上;
以第一构件(4)和第二构件(5)的连接点J2为坐标原点,构建第二局部坐标系Coord2,所述第二局部坐标系Coord2固定在第二构件(5)上;
以第三构件(6)与第四构件(7)连接的一端的端点J3为坐标原点,构建第三局部坐标系Coord3,所述第三局部坐标系Coord3固定在第三构件(6)上;
以第三构件(6)和第四构件(7)的连接点J4为坐标原点,构建第四局部坐标系Coord4,所述第四局部坐标系Coord4固定在第四构件(7)上;
以第四构件(7)和第五构件(8)的连接点J5为坐标原点,构建第五局部坐标系Coord5,所述第五局部坐标系Coord5固定在第五构件(8)上;
以第五构件(8)与第六构件(9)的连接点J6为坐标原点,构建第六局部坐标系Coord6,所述第六局部坐标系Coord6固定在第六构件(9)上;
以第六构件(9)与第七构件(10)的连接点J7为坐标原点,构建第七局部坐标系Coord7,所述第七局部坐标系Coord7固定在第七构件(10)上;
根据所构建的坐标系Coord0、Coord1、Coord2、Coord3、Coord4、Coord5、Coord6、Coord7,利用空间变换方法,计算凿岩机(11)的凿岩端的在全局坐标系下的空间坐标;
根据凿岩机(11)的凿岩端的在全局坐标系下的空间坐标确定照明摄像装置(3)的调整角度。
8.根据权利要求7所述的凿岩台车照明摄像随动控制方法,其特征在于,利用空间变换方法,计算凿岩机(11)的凿岩端的初始位置在全局坐标系下的空间坐标的方法为:
确定凿岩机(11)的凿岩端在第七局部坐标系Coord7下的初始位置的齐次坐标P0,根据凿岩机(11)的凿岩端的伸长距离,计算第一平移变换矩阵H1,得到变换后凿岩端的齐次坐标P1,其中,P1=H1×P0;
获取的第七构件(10)绕第六局部坐标系Coord6的Y6轴的旋转角度θ1,计算第一旋转变换矩阵R1,确定坐标原点J7在第六局部坐标系Coord6中的齐次坐标PJ6,根据PJ6确定第二平移变换矩阵H2,得到凿岩端初始位置在Coord6中的齐次坐标P2,P2=H2×R1×P1;
获取第六构件(9)绕第五局部坐标系Coord5的X5轴的旋转角度θ2,确定第二旋转变换矩阵R2,确定坐标原点J6在第五局部坐标系Coord5中的齐次坐标PJ5,根据PJ5确定第三平移变换矩阵H3,得到凿岩端初始位置在Coord5中的齐次坐标P3,P3=H3×R2×P2;
获取第五构件(8)绕第四局部坐标系Coord4的Z4轴的旋转角度θ3,确定第三旋转变换矩阵R3,确定坐标原点J5在第四局部坐标系Coord4中的齐次坐标PJ4,根据PJ4确定第四平移变换矩阵H4,得到凿岩端初始位置在Coord4中的齐次坐标P4,P4=H4×R3×P3;
获取第四构件(7)绕第三局部坐标系Coord3的Y3轴的旋转角度θ4,确定第四旋转变换矩阵R4,确定坐标原点J4在第三局部坐标系Coord3中的齐次坐标PJ3,根据PJ3确定第五平移变换矩阵H5,得到凿岩端初始位置在Coord3中的齐次坐标P5,P5=H5×R4×P4;
获取第三构件(6)沿第二局部坐标系Coord2的X2轴方向伸长距离L2,确定第六平移变换矩阵H6,确定坐标原点J3在第二局部坐标系Coord2中的齐次坐标PJ2,根据PJ2确定第七平移变换矩阵H7,得到凿岩端初始位置在Coord2中的齐次坐标P6,P6=H7×H6×P5;
获取第二构件(5)绕第一局部坐标系Coord1的Y1轴的旋转角度θ5,确定第五旋转变换矩阵R5,确定坐标原点J2在第一局部坐标系Coord1中的齐次坐标PJ1,根据PJ1确定第八平移变换矩阵H8,得到凿岩端初始位置在Coord1中的齐次坐标P7,P7=H8×R5×P6;
获取第一构件(4)绕全局坐标系Coord0的Z轴的旋转角度θ6,确定第六旋转变换矩阵R6,确定坐标原点J1在全局坐标系Coord0中的齐次坐标PJ0,根据PJ0确定第九平移变换矩阵H9,得到凿岩端初始位置在Coord0中的齐次坐标P8,P8=H9×R6×P7,即为凿岩端在全局坐标系下的空间坐标。
10.一种凿岩台车,其特征在于,包括权利要求1-5任一项所述的照明摄像随动控制***,并利用权利要求6-9任一项所述照明摄像随动控制方法控制照明摄像装置(3)随动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110093627.6A CN112746812A (zh) | 2021-01-22 | 2021-01-22 | 凿岩台车照明摄像随动***、控制方法及凿岩台车 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110093627.6A CN112746812A (zh) | 2021-01-22 | 2021-01-22 | 凿岩台车照明摄像随动***、控制方法及凿岩台车 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112746812A true CN112746812A (zh) | 2021-05-04 |
Family
ID=75653026
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110093627.6A Pending CN112746812A (zh) | 2021-01-22 | 2021-01-22 | 凿岩台车照明摄像随动***、控制方法及凿岩台车 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112746812A (zh) |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0874296A (ja) * | 1994-09-02 | 1996-03-19 | Shin Caterpillar Mitsubishi Ltd | 建設機械におけるカメラ自動追尾制御装置 |
CN1600488A (zh) * | 2004-10-21 | 2005-03-30 | 上海交通大学 | 焊缝自主跟踪方法 |
CN1721142A (zh) * | 2004-07-15 | 2006-01-18 | 中国科学院自动化研究所 | 一种五自由度立体视觉监控装置 |
JP2010270518A (ja) * | 2009-05-22 | 2010-12-02 | Enzan Kobo:Kk | 削岩機搭載台車における穿孔位置決め制御方法及びトンネル施工機械におけるブーム移動制御方法 |
CN103503639A (zh) * | 2013-09-30 | 2014-01-15 | 常州大学 | 一种双臂果蔬采收机器人***及其果蔬采收方法 |
CN103522303A (zh) * | 2013-10-30 | 2014-01-22 | 重庆科技学院 | 排爆机器人排爆装置及其控制***和控制方法 |
CN107885916A (zh) * | 2017-10-27 | 2018-04-06 | 西安工业大学 | 一种基于cfdh法的凿岩台车钻臂运动学分析方法 |
CN108301766A (zh) * | 2018-02-08 | 2018-07-20 | 北京科技大学 | 一种钻孔自动定位凿岩台车的双钻臂车体定位方法 |
CN109940662A (zh) * | 2017-12-20 | 2019-06-28 | 发那科株式会社 | 具备拍摄工件的视觉传感器的摄像装置 |
CN110051436A (zh) * | 2018-01-18 | 2019-07-26 | 上海舍成医疗器械有限公司 | 自动化协同工作组件及其在手术器械中的应用 |
CN110337528A (zh) * | 2017-02-27 | 2019-10-15 | 安百拓凿岩有限公司 | 用于生成钻孔图案的方法和***及岩石钻机 |
CN111274696A (zh) * | 2020-01-19 | 2020-06-12 | 徐州徐工铁路装备有限公司 | 一种实时获取凿岩台车双三角钻臂空间位置姿态的方法 |
CN214365866U (zh) * | 2021-01-22 | 2021-10-08 | 安百拓(南京)建筑矿山设备有限公司 | 凿岩台车照明摄像随动***及凿岩台车 |
-
2021
- 2021-01-22 CN CN202110093627.6A patent/CN112746812A/zh active Pending
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0874296A (ja) * | 1994-09-02 | 1996-03-19 | Shin Caterpillar Mitsubishi Ltd | 建設機械におけるカメラ自動追尾制御装置 |
CN1721142A (zh) * | 2004-07-15 | 2006-01-18 | 中国科学院自动化研究所 | 一种五自由度立体视觉监控装置 |
CN1600488A (zh) * | 2004-10-21 | 2005-03-30 | 上海交通大学 | 焊缝自主跟踪方法 |
JP2010270518A (ja) * | 2009-05-22 | 2010-12-02 | Enzan Kobo:Kk | 削岩機搭載台車における穿孔位置決め制御方法及びトンネル施工機械におけるブーム移動制御方法 |
CN103503639A (zh) * | 2013-09-30 | 2014-01-15 | 常州大学 | 一种双臂果蔬采收机器人***及其果蔬采收方法 |
CN103522303A (zh) * | 2013-10-30 | 2014-01-22 | 重庆科技学院 | 排爆机器人排爆装置及其控制***和控制方法 |
CN110337528A (zh) * | 2017-02-27 | 2019-10-15 | 安百拓凿岩有限公司 | 用于生成钻孔图案的方法和***及岩石钻机 |
CN107885916A (zh) * | 2017-10-27 | 2018-04-06 | 西安工业大学 | 一种基于cfdh法的凿岩台车钻臂运动学分析方法 |
CN109940662A (zh) * | 2017-12-20 | 2019-06-28 | 发那科株式会社 | 具备拍摄工件的视觉传感器的摄像装置 |
CN110051436A (zh) * | 2018-01-18 | 2019-07-26 | 上海舍成医疗器械有限公司 | 自动化协同工作组件及其在手术器械中的应用 |
CN108301766A (zh) * | 2018-02-08 | 2018-07-20 | 北京科技大学 | 一种钻孔自动定位凿岩台车的双钻臂车体定位方法 |
CN111274696A (zh) * | 2020-01-19 | 2020-06-12 | 徐州徐工铁路装备有限公司 | 一种实时获取凿岩台车双三角钻臂空间位置姿态的方法 |
CN214365866U (zh) * | 2021-01-22 | 2021-10-08 | 安百拓(南京)建筑矿山设备有限公司 | 凿岩台车照明摄像随动***及凿岩台车 |
Non-Patent Citations (2)
Title |
---|
刘泽鑫等: "凿岩台车钻臂工作空间求解", 《机械》 * |
罗生梅等: "凿岩钻车机械臂的运动学分析与建模", 《矿山机械》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CA2775641C (en) | Apparatus and methods of positioning a subsea object | |
CN102561700B (zh) | 一种机械臂控制***、方法及工程机械 | |
CN102535852B (zh) | 一种机械臂操控***、方法及工程机械 | |
US20060188250A1 (en) | Robot imaging device | |
CN102393754B (zh) | 臂架动作控制方法、***及臂架末端直线位移控制方法、***及混凝土泵车 | |
CN214365866U (zh) | 凿岩台车照明摄像随动***及凿岩台车 | |
CN112537719B (zh) | 基于视觉定位的gis管道自动对接装置及其工作方法 | |
CN213865002U (zh) | 基于视觉定位的gis管道自动对接装置 | |
CN108362336B (zh) | 用于大空间公共场所的并联柔索式空气检测***及方法 | |
CN109625165B (zh) | 一种海上浮式结构运动的模拟方法 | |
CN112746812A (zh) | 凿岩台车照明摄像随动***、控制方法及凿岩台车 | |
US20240093827A1 (en) | Amphibious robot for in-service inspection of drainage pipelines and control method thereof | |
CN106584484A (zh) | 一种机身旋转式架空线路作业机器人结构及应用 | |
CN108638103A (zh) | 一种自动抓取及位姿调整的机器人末端执行器及调整方法 | |
CN2601390Y (zh) | 微型顶管机的机头姿态激光测量装置 | |
CN115962372A (zh) | 一种悬挂巡查的管道侦查机器人及悬挂巡查方法 | |
CN115072564A (zh) | 一种自动跟踪起重机吊载位置的装置及方法 | |
CN210027842U (zh) | 一种海上浮式结构运动的模拟*** | |
CN205778928U (zh) | 一种混凝土喷射车 | |
CN112010167B (zh) | 叶片吊具的控制方法及*** | |
CN114434448B (zh) | 破拆机器人的工作臂控制方法及控制*** | |
CN110485947A (zh) | 钻具移动控制装置、钻井设备及钻具移动控制方法 | |
CN220647584U (zh) | 一种基于机器视觉的水利工程远程监测装置 | |
CN220948586U (zh) | 一种水利工程uav搭载的机器视觉模块 | |
CN220811469U (zh) | 油管缠管监控*** |
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 |