CN105627056A - 一种自动调节角度的工业相机支架及其控制方法 - Google Patents

一种自动调节角度的工业相机支架及其控制方法 Download PDF

Info

Publication number
CN105627056A
CN105627056A CN201610180345.9A CN201610180345A CN105627056A CN 105627056 A CN105627056 A CN 105627056A CN 201610180345 A CN201610180345 A CN 201610180345A CN 105627056 A CN105627056 A CN 105627056A
Authority
CN
China
Prior art keywords
servo
servomotor
driver
formula
servomotors
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
Application number
CN201610180345.9A
Other languages
English (en)
Other versions
CN105627056B (zh
Inventor
齐继阳
魏赛
唐文献
陆震云
王凌云
李钦奉
苏世杰
张建
孟洋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China E Tech Ningbo Maritime Electronics Research Institute Co ltd
Original Assignee
Jiangsu University of Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Jiangsu University of Science and Technology filed Critical Jiangsu University of Science and Technology
Priority to CN201610180345.9A priority Critical patent/CN105627056B/zh
Publication of CN105627056A publication Critical patent/CN105627056A/zh
Application granted granted Critical
Publication of CN105627056B publication Critical patent/CN105627056B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/12Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting in more than one direction
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/18Heads with mechanism for moving the apparatus relatively to the stand
    • GPHYSICS
    • G03PHOTOGRAPHY; CINEMATOGRAPHY; ANALOGOUS TECHNIQUES USING WAVES OTHER THAN OPTICAL WAVES; ELECTROGRAPHY; HOLOGRAPHY
    • G03BAPPARATUS OR ARRANGEMENTS FOR TAKING PHOTOGRAPHS OR FOR PROJECTING OR VIEWING THEM; APPARATUS OR ARRANGEMENTS EMPLOYING ANALOGOUS TECHNIQUES USING WAVES OTHER THAN OPTICAL WAVES; ACCESSORIES THEREFOR
    • G03B17/00Details of cameras or camera bodies; Accessories therefor
    • G03B17/56Accessories
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • G05D3/125Control of position or direction using feedback using discrete position sensor
    • G05D3/127Control of position or direction using feedback using discrete position sensor with electrical contact

Abstract

一种自动调节角度的工业相机支架,包括相机支架和控制系统,相机支架包括底座,其中心设有导向柱、导向柱套装在平台导向孔中,平台上方有二号活动块,下方有一号伺服电机,其输出轴与二号活动块连接、二号活动块设台阶轴,与一号活动块间隙配合,一号活动块上设下铰耳,通过小轴铰接相机托盘,一号活动块安装轴端设有二号同步带轮的二号伺服电机,小轴的一端设有一号同步带轮,其与二号同步带轮通过同步带传动连接,相机托盘上设有测距传感器,控制系统包括控制器、数字量采集、运动控制和模拟量采集模块。本发明相机支架,能快速准确调节相机角度,使相机镜头平面和对象平面自动保持平行。本发明还公开了自动调节角度的工业相机支架的控制方法。

Description

一种自动调节角度的工业相机支架及其控制方法
技术领域
本发明涉及一种工业相机支架及其控制方法,尤其涉及一种能自动调节角度的工业相机支架及其控制方法,属于基于图像测量的工程应用领域。
背景技术
相机支架作为相机使用配件中最主要的工具而被广泛使用,应用于日常生活及专业图像采集等各个领域,使用者对相机支架的功能需求越来越高。普通的相机支架多数仅起到了对相机的固定作用,如果在拍摄过程中需要改变拍摄位置时,拍摄者就要重新对相机支架进行重新调整,过程繁琐,比较麻烦,延长了不必要的拍摄时间。
在工业界在线图像采集中,相机的位置对于能否准确地采集到所需图像是至关重要的,相机位置得当,则能够准确地捕获到产品图像。当需要获取与相机镜头平行的平面图像时,需要多次手动调节相机镜头角度,而且单凭肉眼观察进行的角度调节无法满足相机与拍摄对象平行度的要求,进而增加了拍摄者的工作量,降低了拍摄效率和拍摄精度。
发明内容
鉴于背景技术中存在的问题,本发明的目的是提供一种自动调节角度的工业相机支架及其控制方法。本发明可以实现相机位置的上下移动、左右旋转和俯仰调整。在拍摄过程中保证相机镜头平面与被拍摄平面保持平行,给精密测量提供了可靠的保证。
为了实现上述目的,本发明采用的技术方案是:
一种自动调节角度的工业相机支架,包括相机支架和控制所述相机支架的控制系统,所述相机支架包括:两侧板沿垂直方向对称设有滑槽的倒门框形底座,所述底座的底板中心垂直向上设置有导向柱、所述导向柱穿装在平台的导向孔中,螺栓穿过所述底座侧板的滑槽与设置在所述平台侧面的螺纹孔连接,所述平台一端的上方设置有二号活动块,其下方安装有一号伺服电机,所述一号伺服电机的输出轴穿过所述平台上的导向孔与所述二号活动块固定连接、所述二号活动块伸出所述平台的一端由外向内设置有一小一大圆柱状台阶轴,所述外端的台阶轴与一端设置有与其配合的孔的一号活动块形成间隙配合,并通过设置在所述台阶轴轴端的压紧螺栓将所述一号活动块压紧在所述台阶轴的轴肩上,所述一号活动块的另一端设置有带光孔的下铰耳,所述下铰耳上通过截面为异形的小轴与相机托盘底部的托板下方的上铰耳相铰接,所述上铰耳的铰接孔与所述小轴截面形状一致,所述一号活动块的一侧水平安装有二号伺服电机,所述二号伺服电机的轴端安装有二号同步带轮,所述小轴朝向所述二号伺服电机输出轴的一端安装有一号同步带轮,所述一号同步带轮与所述二号同步带轮通过同步带传动连接,所述相机托盘还包括侧壁板和盖板,所述相机托盘底部的托板、所述侧壁板和所述盖板共同构成容纳相机的空腔,所述相机托盘底部的托板的两端以及所述盖板的中部共设置有三个测距传感器,所述三个测距传感器的测量端处于同一平面且都朝向相机的拍摄方向;所述控制系统包括控制器和与所述控制器连接的数字量采集模块、运动控制模块和模拟量采集模块,所述数字量采集模块还连接有启动按钮、停止按钮和复位按钮,所述运动控制模块连接用来驱动所述一号伺服电机的一号伺服驱动器和用来驱动所述二号伺服电机的二号伺服驱动器,所述模拟量采集模块连接所述三个测距传感器。
进一步,所述相机托盘的所述侧壁板和所述盖板上设置有用于固定和调整相机位置的调节螺钉。
优选的,所述平台包括相互垂直呈T形设置的上平台和下平台,所述上平台的一端为半圆形,所述二号活动块设置在所述上平台半圆形一端的上方,所述下平台的侧面开设有与所述螺栓连接的螺纹孔,所述螺栓与所述底座的侧板滑槽之间还设置有大垫片。
进一步,所述二号伺服电机通过二号电机安装螺栓以及二号电机安装螺母安装在电机安装板上,所述电机安装板通过安装板螺栓和安装板螺母安装在所述一号活动块的侧面。
进一步,所述导向柱通过其端部的螺纹安装在所述底座底板中心的螺纹孔中。
进一步,所述测距传感器通过螺钉安装在相机托盘底部的托板两端和盖板的中部。
动作原理:
通过松开所述螺栓,可以让所述平台沿着所述导向柱上下移动,同时带动相机实现上下调节。
通过所述一号伺服电机的转动,带动所述二号活动块转动,则相机也同时左右转动,可以实现的转动范围为180度。
通过松开所述压紧螺栓,所述一号活动块可以绕着二号活动块外端的台阶轴实现大角度的旋转,进而使相机实现转动。
通过所述二号伺服电机的转动带动所述二号同步带轮转动,所述二号同步带轮通过所述同步带带动所述一号同步带轮转动,所述一号同步带轮转动带动所述小轴的转动,所述小轴转动带动所述相机托盘的转动,从而实现相机的俯仰调节。
所述三个测距传感器,可以准确测出所述相机平面与所述被测平面的距离,控制程序根据不同的距离差值,通过控制所述一号伺服电机和二号伺服电机的旋转角度,从而准确调整所述相机支架的左右旋转和俯仰位置,从而保证了所述相机平面与所述被测平面的平行。
为了实现上述目的,本发明采用的另一技术方案是:
本发明的一种自动调节角度的工业相机支架的控制方法,包括如下步骤:
步骤一:按下所述启动按钮,所述控制器分别读取所述一号伺服驱动器和所述二号伺服驱动器的就绪信号以及由所述三个距离传感器测出的所述相机平面到被测平面的距离△H1、△H2和△H3;
步骤二:比较所述三个距离△H1、△H2和△H3的大小,
A、如果△H3﹥△H2﹥△H1或△H2﹥△H3﹥△H1,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机、所述二号伺服驱动器驱动所述二号伺服电机反转,直到△H1=△H2=△H3,所述一号伺服电机和所述二号伺服电机停止转动,
所述一号伺服电机(8)需要转动的角度可由公式(1-1)计算出:
ω 1 = a r c s i n ΔH 2 - ΔH 1 i 1 L 1 - - - ( 1 - 1 )
式中,i1是所述一号伺服电机的输出轴到所述二号活动块之间的传动比,L1是所述相机托盘底部的托板两端的所述测距传感器之间直线距离,
所述控制器需要向所述一号伺服驱动器发送的脉冲数p1可由公式(2-2)计算出:
p 1 = ω 1 α 1 360 - - - ( 2 - 2 )
式中,α1是所述一号伺服电机的编码器每转脉冲数,
所述二号伺服电机需要转动的角度可由公式(3-3)计算出:
ω 2 = a r c s i n ΔH 2 - ΔH 1 i 2 L 2 - - - ( 3 - 3 )
式中,i2是所述二号伺服电机的输出轴到所述一号同步带轮的传动比,L2是所述盖板中部的所述测距传感器到所述相机托盘底部的托板两端任一所述测距传感器的垂直距离,
控制器需要向所述二号伺服驱动器发送的脉冲数p2可由公式(4-4)计算出:
p 2 = ω 2 α 2 360 - - - ( 4 - 4 )
式中,α2是所述二号伺服电机编码器每转脉冲数;
B、如果△H1﹥△H3﹥△H2,或△H1﹥△H2﹥△H3,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机、所述二号伺服驱动器驱动二号伺服电机正转,直到△H1=△H2=△H3,所述一号伺服电机和所述二号伺服电机停止转动,同理,所述一号伺服电机需要转动的角度由公式(1-1)可得,所述控制器需要向所述一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机需要转动的角度由公式(3-3)可得,所述控制器需要向二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
C、如果△H3﹥△H1﹥△H2,且所述一号伺服驱动器和所述二号伺服驱动器就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机正转、所述二号伺服驱动器驱动所述二号伺服电机反转,直到△H1=△H2=△H3,所述一号伺服电机和所述二号伺服电机停止转动,同理,所述一号伺服电机需要转动的角度由公式(1-1)可得,所述控制器需要向一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机需要转动的角度由公式(3-3)可得,所述控制器需要向二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
D、如果△H2﹥△H1﹥△H3,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机反转、所述二号伺服驱动器驱动所述二号伺服电机正转,直到△H1=△H2=△H3,所述一号伺服伺服电机和所述二号伺服电机停止转动,同理,所述一号伺服电机需要转动的角度由公式(1-1)可得,所述控制器需要向所述一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机需要转动的角度由公式(3-3)可得,所述控制器需要向所述二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
步骤三:按下所述停止按钮,所述控制器停止向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服电机和所述二号伺服电机停止转动;
步骤四:按下所述复位按钮,所述控制器发送脉冲指令给所述一号伺服驱动器和所述二号伺服驱动器,从而驱动所述一号伺服电机和所述二号伺服电机回到标定的原点位置。
本发明的优点和有益效果如下:
本发明提供的自动调节角度的工业相机支架及其控制方法,可以快速准确地调节工业相机的角度,使相机镜头平面和被拍摄的对象平面自动保持平行,使获取的图像满足基于机器视觉在线精密测量的要求。
本发明提供的自动调节角度工业相机支架及其控制方法,避免了手持拍摄,减轻工作强度,提高工作效率,稳定性好,实用性高。
附图说明
图1是本发明实施例的主视图;
图2是本发明实施例A处的放大图;
图3是本发明实施例B处的放大图;
图4是本发明实施例C处的放大图;
图5是本发明实施例的左视图;
图6是本发明实施例D处的放大图;
图7是本发明实施例E处的放大图;
图8是本发明实施例的俯视图;
图9是本发明实施例F处的放大图;
图10是本发明实施例的右视图;
图11是本发明实施例测距传感器与被测平面的原理示意图;
图12是本发明实施例中测距传感器分布位置图;
图13是本发明实施例的控制系统图;
其中有:1、导向柱;2、平台;3、压紧螺栓;4、大垫片;5、一号活动块;6、小轴;7、调节螺钉;8、一号伺服电机;9、一号电机安装螺母;10、一号电机安装螺栓;11、二号活动块;12、二号同步带轮;13、一号同步带轮;14、盖板固定螺钉;15、测距传感器;16、盖板;18、二号电机安装螺栓;19、二号电机安装螺母;20、螺栓;21、底座;22、电机安装板;23、二号伺服电机;24.安装板螺栓;25、安装板螺母;26、同步带;27、螺钉;28.相机托盘;29、相机平面;30、被测平面。
具体实施方式
下面将结合本发明实施例中的附图1至附图13,对本发明实的技术方案进行清楚、完整地描述。
如图1至10所示:一种能自动调节角度的工业相机支架,包括相机支架和控制所述相机支架的控制系统,所述相机支架包括两侧板沿垂直方向对称设有滑槽的倒门框形底座21,所述底座21的底板中心垂直向上设置有导向柱1、所述导向柱1穿装在平台2的导向孔中,螺栓20穿过所述底座21侧板的滑槽与设置在所述平台2侧面的螺纹孔连接,所述平台2一端的上方设置有二号活动块11,其下方安装有一号伺服电机8,所述一号伺服电机8的输出轴穿过所述平台2上的导向孔与所述二号活动块11固定连接、所述二号活动块11伸出所述平台2的一端由外向内设置有一小一大圆柱状台阶轴,所述外端的台阶轴与一端设置有与其配合的孔的一号活动块5形成间隙配合,并通过设置在所述台阶轴轴端的压紧螺栓3将所述一号活动块5压紧在所述台阶轴的轴肩上,所述一号活动块5的另一端设置有带光孔的下铰耳,所述下铰耳上通过截面为异形的小轴6与相机托盘28底部的托板下方的上铰耳相铰接,所述上铰耳的铰接孔与所述小轴6截面形状一致,所述一号活动块5的一侧水平安装有二号伺服电机23,所述二号伺服电机23的轴端安装有二号同步带轮12,所述小轴6朝向所述二号伺服电机23输出轴的一端安装有一号同步带轮13,所述一号同步带轮13与所述二号同步带轮12通过同步带26传动连接,所述相机托盘28还包括侧壁板和盖板16,所述相机托盘28底部的托板、所述侧壁板和所述盖板16共同构成容纳相机的空腔,所述相机托盘28底部的托板的两端以及所述盖板16的中部共设置有三个测距传感器15,所述三个测距传感器15的测量端处于同一平面且都朝向相机的拍摄方向;所述控制系统包括控制器和与所述控制器连接的数字量采集模块、运动控制模块和模拟量采集模块,所述数字量采集模块还连接有启动按钮、停止按钮和复位按钮,所述运动控制模块连接用来驱动所述一号伺服电机8的一号伺服驱动器和用来驱动所述二号伺服电机23的二号伺服驱动器,所述模拟量采集模块连接所述三个测距传感器15。
如图1所示:所述相机托盘28的所述侧壁板和所述盖板16上设置有用于固定和调整相机位置的调节螺钉7。
如图1所示:所述平台2包括相互垂直呈T形设置的上平台和下平台,所述上平台的一端为半圆形,所述二号活动块11设置在所述上平台半圆形一端的上方,所述下平台的侧面开设有与所述螺栓20连接的螺纹孔,所述螺栓20与所述底座21的侧板滑槽之间还设置有大垫片4。
如图8、9和图10所示:所述二号伺服电机23通过二号电机安装螺栓18以及二号电机安装螺母19安装在电机安装板22上,所述电机安装板22通过安装板螺栓24和安装板螺母25安装在所述一号活动块5的侧面。
如图1和图4所示:所述导向柱1的一端设有螺纹,所述底座21底板的中心设有螺纹孔,所述导向柱1通过其端部的螺纹安装在所述底座21底板中心的螺纹孔中。
如图2所示:所述测距传感器15通过螺钉27安装在相机托盘28底部的托板两端和盖板16的中部。
如图5和图7所示:所述一号伺服电机8通过一号电机安装螺栓10和一号电机安装螺母9固定在所述平台2的下方。
如图6所示:所述盖板16通过盖板固定螺栓14固定在所述相机托盘28的侧壁板上。
如图13所示,本发明还提供上述相机支架的控制系统,所述控制系统包括控制器、数字量采集模块、运动控制模块和模拟量采集模块,所述数字量采集模块还连接有启动按钮、停止按钮和复位按钮,所述运动控制模块连接用来驱动所述一号伺服电机8的一号伺服驱动器和用来驱动所述二号伺服电机23的二号伺服驱动器,所述模拟量采集模块连接所述三个测距传感器15,通过读取所述三个测距传感器15的读数,可以准确获知相机平面29与被测平面30的位置关系(如图11所示)。
动作原理:
通过松开所述螺栓20,可以让所述平台2沿着所述导向柱1上下移动,同时带动相机实现上下调节。
通过所述一号伺服电机8的转动,可以带动所述二号活动块11转动,则相机也同时左右转动,可以实现的转动范围为180度。
通过松开所述压紧螺栓3,所述一号活动块5可以绕着二号活动块11外端的台阶轴实现大角度的旋转,进而使相机实现转动。
通过所述二号伺服电机23的转动带动所述二号同步带轮12转动,所述二号同步带轮12通过所述同步带26带动所述一号同步带轮13转动,所述一号同步带轮13转动带动所述小轴6的转动,所述小轴6转动带动所述相机托盘28的转动,从而实现相机的俯仰调节。
如图1、11和图12所示:所述三个测距传感器15,可以准确测出所述相机平面29与所述被测平面30的距离,控制程序根据不同的距离差值,通过控制所述一号伺服电机8和二号伺服电机23的旋转角度,从而准确调整所述相机支架的左右旋转和俯仰位置,从而保证了所述相机平面29与所述被测平面30的平行。
如图11至图13,上述自动调节角度的工业相机支架的控制方法:
步骤一:按下所述启动按钮,所述控制器分别读取所述一号伺服驱动器和所述二号伺服驱动器的就绪信号以及由所述三个距离传感器15测出的所述相机平面29到被测平面30的距离△H1、△H2和△H3;
步骤二:比较所述三个距离△H1、△H2和△H3的大小,
A、如果△H3﹥△H2﹥△H1或△H2﹥△H3﹥△H1,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机8、所述二号伺服驱动器驱动所述二号伺服电机23反转,直到△H1=△H2=△H3,所述一号伺服电机8和所述二号伺服电机23停止转动,
所述一号伺服电机8需要转动的角度可由公式(1-1)计算出:
ω 1 = a r c s i n ΔH 2 - ΔH 1 i 1 L 1 - - - ( 1 - 1 )
式中,i1是所述一号伺服电机8的输出轴到所述二号活动块11之间的传动比,L1是所述相机托盘28底部的托板两端的所述测距传感器15之间直线距离,
所述控制器需要向所述一号伺服驱动器发送的脉冲数p1可由公式(2-2)计算出:
p 1 = ω 1 α 1 360 - - - ( 2 - 2 )
式中,α1是所述一号伺服电机8的编码器每转脉冲数,
所述二号伺服电机23需要转动的角度可由公式(3-3)计算出:
ω 2 = a r c s i n ΔH 3 - ΔH 1 i 2 L 2 - - - ( 3 - 3 )
式中,i2是所述二号伺服电机23的输出轴到所述一号同步带轮13的传动比,L2是所述盖板16中部的所述测距传感器15到所述相机托盘28底部的托板两端任一所述测距传感器15的垂直距离,
控制器需要向所述二号伺服驱动器发送的脉冲数p2可由公式(4-4)计算出:
p 2 = ω 2 α 2 360 - - - ( 4 - 4 )
式中,α2是所述二号伺服电机23编码器每转脉冲数;
B、如果△H1﹥△H3﹥△H2,或△H1﹥△H2﹥△H3,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机8、所述二号伺服驱动器驱动二号伺服电机23正转,直到△H1=△H2=△H3,所述一号伺服电机8和所述二号伺服电机23停止转动,同理,所述一号伺服电机8需要转动的角度由公式(1-1)可得,所述控制器需要向所述一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机23需要转动的角度由公式(3-3)可得,所述控制器需要向二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
C、如果△H3﹥△H1﹥△H2,且所述一号伺服驱动器和所述二号伺服驱动器就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机8正转、所述二号伺服驱动器驱动所述二号伺服电机23反转,直到△H1=△H2=△H3,所述一号伺服电机8和所述二号伺服电机23停止转动,同理,所述一号伺服电机8需要转动的角度由公式(1-1)可得,所述控制器需要向一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机23需要转动的角度由公式(3-3)可得,所述控制器需要向二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
D、如果△H2﹥△H1﹥△H3,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机8反转、所述二号伺服驱动器驱动所述二号伺服电机23正转,直到△H1=△H2=△H3,所述一号伺服伺服电机8和所述二号伺服电机23停止转动,同理,所述一号伺服电机8需要转动的角度由公式(1-1)可得,所述控制器需要向所述一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机23需要转动的角度由公式(3-3)可得,所述控制器需要向所述二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
步骤三:按下所述停止按钮,所述控制器停止向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服电机8和所述二号伺服电机23停止转动;
步骤四:按下所述复位按钮,所述控制器发送脉冲指令给所述一号伺服驱动器和所述二号伺服驱动器,从而驱动所述一号伺服电机8和所述二号伺服电机23回到标定的原点位置。
除上述实施例外,本发明还可以有其他实施方式,凡采用等同替换或等效变换形成的技术方案,均落在本发明要求的保护范围内。

Claims (7)

1.一种自动调节角度的工业相机支架,包括相机支架和控制所述相机支架的控制系统,其特征在于:所述相机支架包括两侧板沿垂直方向对称设有滑槽的倒门框形底座(21),所述底座(21)的底板中心垂直向上设置有导向柱(1)、所述导向柱(1)穿装在平台(2)的导向孔中,螺栓(20)穿过所述底座(21)侧板的滑槽与设置在所述平台(2)侧面的螺纹孔连接,所述平台(2)一端的上方设置有二号活动块(11),其下方安装有一号伺服电机(8),所述一号伺服电机(8)的输出轴穿过所述平台(2)上的导向孔与所述二号活动块(11)固定连接、所述二号活动块(11)伸出所述平台(2)的一端由外向内设置有一小一大圆柱状台阶轴,所述外端的台阶轴与一端设置有与其配合的孔的一号活动块(5)形成间隙配合,并通过设置在所述台阶轴轴端的压紧螺栓(3)将所述一号活动块(5)压紧在所述台阶轴的轴肩上,所述一号活动块(5)的另一端设置有带光孔的下铰耳,所述下铰耳上通过截面为异形的小轴(6)与相机托盘(28)底部的托板下方的上铰耳相铰接,所述上铰耳的铰接孔与所述小轴(6)截面形状一致,所述一号活动块(5)的一侧水平安装有二号伺服电机(23),所述二号伺服电机(23)的轴端安装有二号同步带轮(12),所述小轴(6)朝向所述二号伺服电机(23)输出轴的一端安装有一号同步带轮(13),所述一号同步带轮(13)与所述二号同步带轮(12)通过同步带(26)传动连接,所述相机托盘(28)还包括侧壁板和盖板(16),所述相机托盘(28)底部的托板、所述侧壁板和所述盖板(16)共同构成容纳相机的空腔,所述相机托盘(28)底部的托板的两端以及所述盖板(16)的中部共设置有三个测距传感器(15),所述三个测距传感器(15)的测量端处于同一平面且都朝向相机的拍摄方向;所述控制系统包括控制器和与所述控制器连接的数字量采集模块、运动控制模块和模拟量采集模块,所述数字量采集模块还连接有启动按钮、停止按钮和复位按钮,所述运动控制模块连接用来驱动所述一号伺服电机(8)的一号伺服驱动器和用来驱动所述二号伺服电机(23)的二号伺服驱动器,所述模拟量采集模块连接所述三个测距传感器(15)。
2.如权利要求1所述的一种自动调节角度的工业相机支架,其特征在于:所述相机托盘(28)的所述侧壁板和所述盖板(16)上设置有用于固定和调整相机位置的调节螺钉(7)。
3.如权利要求1所述的一种自动调节角度的工业相机支架,其特征在于:所述平台(2)包括相互垂直呈T形设置的上平台和下平台,所述上平台的一端为半圆形,所述二号活动块(11)设置在所述上平台半圆形一端的上方,所述下平台的侧面开设有与所述螺栓(20)连接的螺纹孔,所述螺栓(20)与所述底座(21)的侧板滑槽之间还设置有大垫片(4)。
4.如权利要求1所述的一种自动调节角度的工业相机支架,其特征在于:所述二号伺服电机(23)通过二号电机安装螺栓(18)以及二号电机安装螺母(19)安装在电机安装板(22)上,所述电机安装板(22)通过安装板螺栓(24)和安装板螺母(25)安装在所述一号活动块(5)的侧面。
5.如权利要求1所述的一种自动调节角度的工业相机支架,其特征在于:所述导向柱(1)通过其端部的螺纹安装在所述底座(21)底板中心的螺纹孔中。
6.如权利要求1所述的一种自动调节角度的工业相机支架,其特征在于:所述测距传感器(15)通过螺钉(27)安装在相机托盘(28)底部的托板两端和盖板(16)的中部。
7.一种如权利要求1至6中任意一项所述的自动调节角度的工业相机支架的控制方法,其特征在于包括如下步骤:
步骤一:按下所述启动按钮,所述控制器分别读取所述一号伺服驱动器和所述二号伺服驱动器的就绪信号以及由所述三个距离传感器(15)测出的所述相机平面(29)到被测平面(30)的距离ΔH1、ΔH2和ΔH3;
步骤二:比较所述三个距离ΔH1、ΔH2和ΔH3的大小,
A、如果ΔH3﹥ΔH2﹥ΔH1或ΔH2﹥ΔH3﹥ΔH1,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机(8)、所述二号伺服驱动器驱动所述二号伺服电机(23)反转,直到ΔH1=ΔH2=ΔH3,所述一号伺服电机(8)和所述二号伺服电机(23)停止转动,
所述一号伺服电机(8)需要转动的角度可由公式(1-1)计算出:
ω 1 = arcsin ΔH 2 - ΔH 1 i 1 L 1 - - - ( 1 - 1 )
式中,i1是所述一号伺服电机(8)的输出轴到所述二号活动块(11)之间的传动比,L1是所述相机托盘(28)底部的托板两端的所述测距传感器(15)之间直线距离,
所述控制器需要向所述一号伺服驱动器发送的脉冲数p1可由公式(2-2)计算出:
p 1 = ω 1 α 1 360 - - - ( 2 - 2 )
式中,α1是所述一号伺服电机(8)的编码器每转脉冲数,
所述二号伺服电机(23)需要转动的角度可由公式(3-3)计算出:
ω 2 = arcsin ΔH 3 - ΔH 1 i 2 L 2 - - - ( 3 - 3 )
式中,i2是所述二号伺服电机(23)的输出轴到所述一号同步带轮(13)的传动比,L2是所述盖板(16)中部的所述测距传感器(15)到所述相机托盘(28)底部的托板两端任一所述测距传感器(15)的垂直距离,
控制器需要向所述二号伺服驱动器发送的脉冲数p2可由公式(4-4)计算出:
p 2 = ω 2 α 2 360 - - - ( 4 - 4 )
式中,α2是所述二号伺服电机(23)编码器每转脉冲数;
B、如果ΔH1﹥ΔH3﹥ΔH2,或ΔH1﹥ΔH2﹥ΔH3,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机(8)、所述二号伺服驱动器驱动二号伺服电机(23)正转,直到ΔH1=ΔH2=ΔH3,所述一号伺服电机(8)和所述二号伺服电机(23)停止转动,同理,所述一号伺服电机(8)需要转动的角度由公式(1-1)可得,所述控制器需要向所述一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机(23)需要转动的角度由公式(3-3)可得,所述控制器需要向二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
C、如果ΔH3﹥ΔH1﹥ΔH2,且所述一号伺服驱动器和所述二号伺服驱动器就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机(8)正转、所述二号伺服驱动器驱动所述二号伺服电机(23)反转,直到ΔH1=ΔH2=ΔH3,所述一号伺服电机(8)和所述二号伺服电机(23)停止转动,同理,所述一号伺服电机(8)需要转动的角度由公式(1-1)可得,所述控制器需要向一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机(23)需要转动的角度由公式(3-3)可得,所述控制器需要向二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
D、如果ΔH2﹥ΔH1﹥ΔH3,且所述一号伺服驱动器和所述二号伺服驱动器的就绪信号均为1,则所述控制器向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服驱动器驱动所述一号伺服电机(8)反转、所述二号伺服驱动器驱动所述二号伺服电机(23)正转,直到ΔH1=ΔH2=ΔH3,所述一号伺服伺服电机(8)和所述二号伺服电机(23)停止转动,同理,所述一号伺服电机(8)需要转动的角度由公式(1-1)可得,所述控制器需要向所述一号伺服驱动器发送的脉冲数可由公式(2-2)计算出,所述二号伺服电机(23)需要转动的角度由公式(3-3)可得,所述控制器需要向所述二号伺服驱动器发送的脉冲数可由公式(4-4)计算出;
步骤三:按下所述停止按钮,所述控制器停止向所述一号伺服驱动器和所述二号伺服驱动器发送脉冲,所述一号伺服电机(8)和所述二号伺服电机(23)停止转动;
步骤四:按下所述复位按钮,所述控制器发送脉冲指令给所述一号伺服驱动器和所述二号伺服驱动器,从而驱动所述一号伺服电机(8)和所述二号伺服电机(23)回到标定的原点位置。
CN201610180345.9A 2016-03-25 2016-03-25 一种自动调节角度的工业相机支架及其控制方法 Expired - Fee Related CN105627056B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610180345.9A CN105627056B (zh) 2016-03-25 2016-03-25 一种自动调节角度的工业相机支架及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610180345.9A CN105627056B (zh) 2016-03-25 2016-03-25 一种自动调节角度的工业相机支架及其控制方法

Publications (2)

Publication Number Publication Date
CN105627056A true CN105627056A (zh) 2016-06-01
CN105627056B CN105627056B (zh) 2017-10-31

Family

ID=56042245

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610180345.9A Expired - Fee Related CN105627056B (zh) 2016-03-25 2016-03-25 一种自动调节角度的工业相机支架及其控制方法

Country Status (1)

Country Link
CN (1) CN105627056B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107030696A (zh) * 2017-04-28 2017-08-11 广州瑞松北斗汽车装备有限公司 一种视觉引导抓手
CN110400502A (zh) * 2019-07-26 2019-11-01 邵东智能制造技术研究院有限公司 机器视觉教学平台

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030077082A1 (en) * 2001-10-22 2003-04-24 Elmo Co., Ltd. Pan/tilt camera system
WO2003096476A1 (fr) * 2002-05-13 2003-11-20 Noureddine Chahed Motorisation d'antenne a tourelle passive
CN1760969A (zh) * 2004-10-13 2006-04-19 宏碁股份有限公司 具自动对位功能的显示装置及其自动对位系统
CN202203616U (zh) * 2011-08-31 2012-04-25 中国航天科工集团第三研究院第八三五八研究所 一种基于180度视角全景摄像机的转动云台
WO2015165109A1 (zh) * 2014-04-30 2015-11-05 深圳市大疆创新科技有限公司 控制装置、及其应用的云台以及控制云台的方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030077082A1 (en) * 2001-10-22 2003-04-24 Elmo Co., Ltd. Pan/tilt camera system
WO2003096476A1 (fr) * 2002-05-13 2003-11-20 Noureddine Chahed Motorisation d'antenne a tourelle passive
CN1760969A (zh) * 2004-10-13 2006-04-19 宏碁股份有限公司 具自动对位功能的显示装置及其自动对位系统
CN202203616U (zh) * 2011-08-31 2012-04-25 中国航天科工集团第三研究院第八三五八研究所 一种基于180度视角全景摄像机的转动云台
WO2015165109A1 (zh) * 2014-04-30 2015-11-05 深圳市大疆创新科技有限公司 控制装置、及其应用的云台以及控制云台的方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107030696A (zh) * 2017-04-28 2017-08-11 广州瑞松北斗汽车装备有限公司 一种视觉引导抓手
CN110400502A (zh) * 2019-07-26 2019-11-01 邵东智能制造技术研究院有限公司 机器视觉教学平台

Also Published As

Publication number Publication date
CN105627056B (zh) 2017-10-31

Similar Documents

Publication Publication Date Title
CN102749041B (zh) 一种螺旋桨型面轮廓误差测量仪及测量方法
CN102692264B (zh) 一种用于质量、质心位置与转动惯量的测试台及测试方法
CN102901450B (zh) 一种测量装置以及轴体检测设备
CN102590796B (zh) 轿车自适应雷达校正装置
CN106370142A (zh) 一种大量程位移传感器校准装置和校准方法
CN205561757U (zh) 测量及校准运动平台定位精度的装置
CN101619965A (zh) 轮对自动测量装置
CN104075890A (zh) 一种伺服电机及谐波减速机综合测试平台
CN104236465A (zh) 螺钉拧紧、中心高检测机
CN104016170B (zh) 一种自动在线纠偏装置
CN101907639A (zh) 六维加速度传感器标定平台
CN104707880A (zh) 一种汽车传动轴圆跳动检测与校直系统及方法
CN102749036A (zh) 一种用于大型自由锻件的直径在线测量装置
CN105627056A (zh) 一种自动调节角度的工业相机支架及其控制方法
CN112113529A (zh) 一种行星齿轮减速器背隙检测装置
CN206348100U (zh) 一种六分量力传感器校准装置
CN110125954A (zh) 一种适用于机械生产车间内使用的快速检测工业机器人
CN216193694U (zh) 无砟轨道板智能精调装置
CN202583453U (zh) 轿车自适应雷达校正装置
CN201020913Y (zh) 全自动锡膏视觉印刷机
CN203337459U (zh) 一种金属丝长度形变测量装置
CN100392348C (zh) 一种电动影像测量仪
CN108016039A (zh) 一种喷头自动调距3d打印机
CN109780381A (zh) 调平机构及调平方法
CN212931306U (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
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20191204

Address after: 315040 Zhejiang city of Ningbo province high tech Zone Juxian 587 Lane Road No. 15 Building 2 building 033 17-1

Patentee after: CHINA E-TECH (NINGBO) MARITIME ELECTRONICS RESEARCH INSTITUTE Co.,Ltd.

Address before: Meng Xi Road 212003 Zhenjiang city of Jiangsu province Jingkou District No. 2

Patentee before: Jiangsu University of Science and Technology

TR01 Transfer of patent right
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20171031