CN110244071B - 一种基于智能控制***的自动化验装置 - Google Patents
一种基于智能控制***的自动化验装置 Download PDFInfo
- Publication number
- CN110244071B CN110244071B CN201910557429.3A CN201910557429A CN110244071B CN 110244071 B CN110244071 B CN 110244071B CN 201910557429 A CN201910557429 A CN 201910557429A CN 110244071 B CN110244071 B CN 110244071B
- Authority
- CN
- China
- Prior art keywords
- test tube
- coordinate
- camera
- image
- coordinate system
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N35/00—Automatic analysis not limited to methods or materials provided for in any single one of groups G01N1/00 - G01N33/00; Handling materials therefor
- G01N35/00584—Control arrangements for automatic analysers
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N35/00—Automatic analysis not limited to methods or materials provided for in any single one of groups G01N1/00 - G01N33/00; Handling materials therefor
- G01N35/0099—Automatic analysis not limited to methods or materials provided for in any single one of groups G01N1/00 - G01N33/00; Handling materials therefor comprising robots or similar manipulators
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N35/00—Automatic analysis not limited to methods or materials provided for in any single one of groups G01N1/00 - G01N33/00; Handling materials therefor
- G01N35/02—Automatic analysis not limited to methods or materials provided for in any single one of groups G01N1/00 - G01N33/00; Handling materials therefor using a plurality of sample containers moved by a conveyor system past one or more treatment or analysis stations
Landscapes
- Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Biochemistry (AREA)
- General Health & Medical Sciences (AREA)
- General Physics & Mathematics (AREA)
- Immunology (AREA)
- Pathology (AREA)
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Automatic Analysis And Handling Materials Therefor (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种基于智能控制***的自动化验装置，该装置包含上位机控制***，机械臂主体，视觉识别***，末端执行装置。上位机控制***主要对整个装置进行***的控制；机械臂主体是整个装置的“身体”，控制整个装置的移动；视觉识别***为本装置的“眼睛”，通过它来确定目标试管的精确位置；末端执行装置为整个装置的执行部件，实现最后一步操作，吸进与排出目标化验试剂。整个自动化验装置的化验效率与准确度与以上各个部分密切相关，缺一不可，以上各个部件牵一发而动全身，只有每个部分都正常工作才能保证整个***的稳定性。本装置采用开放式控制，可实现机械臂移动，试管的识别，吸取与排出试剂，人机交互等工作。
Description
技术领域
本发明涉及智能设备领域，尤其涉及一种基于智能控制***的自动化验装置。
背景技术
目前我国的大部分单位例如工厂和医院都有自己的化验部门，大部分的化验还是靠人力来解决，而且化验的过程单一乏味，浪费人力资源，完全可以用机械臂代替。机器人可以将人力从乏味的工作与工厂的重复劳动中解放出来，虽然它的智能性要不如人类劳动，但是它的灵敏度和精确度都要远大于人类，我们可以设置每一次化验过程的相似度，将每一次的化验容量都设定的一模一样（误差不超过1‰），甚至连机械臂的移动轨迹都可以控制在0.1mm的移动误差之内。更重要的，机械臂可以持续工作不需要休息，它的效率要远远大于人工劳动。
在自动化验机械臂中，视觉识别是最重要的一个部分，他是整个***的“眼睛”，用来使得机械臂能够“看到”试管的位置从而进行识别与定位。我们所需要的，即为快速，精确的识别到试管的位置，这直接决定了装置的工作效率与可靠性。
发明内容
因此，为了克服上述问题，本发明提供一种基于智能控制***的自动化验装置，该装置包含上位机控制***，机械臂主体，视觉识别***，末端执行装置。上位机控制***主要对整个装置进行***的控制；机械臂主体是整个装置的“身体”，控制整个装置的移动；视觉识别***为本装置的“眼睛”，通过它来确定目标试管的精确位置；末端执行装置为整个装置的执行部件，实现最后一步操作，吸进与排出目标化验试剂。整个自动化验装置的化验效率与准确度与以上各个部分密切相关，缺一不可，以上各个部件牵一发而动全身，只有每个部分都正常工作才能保证整个***的稳定性。本装置采用开放式控制，可实现机械臂移动，试管的识别，吸取与排出试剂，人机交互等工作。
本发明提供的基于智能控制***的自动化验装置包括机械臂主体、末端执行器、气泵、试管架、上位机控制***以及视觉识别***。
其中，试管架用于固定试管，视觉识别***设置于机械臂主体上，视觉识别***用于提供目标试管的坐标，并将坐标传输至上位机控制***，上位机控制***的输出端与机械臂主体的输入端连接，上位机控制***根据接收到的目标试管的坐标向机械臂主体发送第一控制指令以控制机械臂主体运动至目标试管位置，上位机控制***的输出端还与气泵的输入端连接，末端执行器安装于机械臂主体末端，末端执行器用于排出与吸入设置于试管架上试管中的待化验的试剂，末端执行器与气泵连接，在机械臂主体的运动至目标试管位置后，上位机控制***向气泵发送第二控制指令以控制气泵通过控制气压的正负以控制末端执行器的工作，末端执行器正下方为试管架。
优选的是，机械臂主体包括第一伺服电机、第二伺服电机、大臂、第三伺服电机、小臂以及联动关节；末端执行器包括注射器和摄像头。
其中，第一伺服电机固定设置于工作平台上，第二伺服电机与第一伺服电机直接连接，大臂的一端与第二伺服电机相连，大臂的另一端与第三伺服电机连接，小臂的一端与第三伺服电机连接，小臂的另一端与联动关节的一端连接，联动关节的另一端设置有注射器，注射器一侧设置有摄像头，第一伺服电机控制大臂左右转动，第二伺服电机控制大臂前后转动，第三伺服电机控制注射器上下运动。
优选的是，视觉识别***提供目标试管的坐标，包括以下步骤：
步骤1：在将摄像头采集的图像经过灰度化、平滑、二值化、提取轮廓并生成中心点，建立一个以像素为单位的直角坐标系uov，每一像素的坐标(u，v)分别代表该像素在数组中的列数与行数，再建立一个物理单位的直角坐标系XO1Y，用来表示图像点的位置，并将直角坐标系XO1Y的原点定在摄像头的主点上，其中，x轴与u轴平行、y轴与v轴平行，uov坐标系的原点定在XO1Y坐标系的左上角，设O1在uov坐标系中的坐标为(u0，v0)，每一个像素在x轴与y轴方向上的物理尺寸为dx，dy，则图像中任意一个像素在两个坐标系下的坐标有如下关系：
x=(u-u0)dx，y=-(v-v0)dy，
转换为矩阵形式为：
步骤2：设ABCD是经过图像处理得到的***试管中心点拟合的矩形，O点是矩形的中点，以O点为原点建立直角坐标系，x轴平行于矩形的长，y轴平行于矩形的宽；设A’B’C’D’是摄像头采集图像的外边框，
是其中点，试管架相对于摄像头的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出。
步骤3：在试管架的平面图像中，以矩形的中心点为原点建立直角坐标系，两个相邻试管的圆心的横向间距和纵向间距都为Δ，设d号试管在试管架上的第a行第b列，其中，试管架最上面一行为第0行，试管架最左边一列为第0列，a、b都为整型，设试管架共6列3行，且试管以试管架左上角第一个为1号试管，按照先从左往右，再从上到下依次排序，则，d号试管的位置P：
步骤4：将d号试管的位置从平面坐标系转换到摄像头坐标系，最终得到P在摄像头坐标中的坐标P’’，坐标P’’为目标试管的坐标。
优选的是，上述步骤1中，将摄像头采集的图像经过灰度化、平滑、二值化、提取轮廓并生成中心点包括如下步骤：
步骤11：将摄像头采集的彩色图像转化成为灰度图像。
步骤12：在对上述灰度图像进行平滑处理的过程中，对图像应用高斯模糊进行噪声去除，减少伪边缘的识别度。
步骤13：在对上述经过平滑处理后的图像进行二值化处理的过程中，首先找到图像中所有像素的最大值和最小值，然后取中心点作为阈值，低于阈值的像素设为黑色，高于或等于阈值的像素设为白色。
步骤14：在对上述经过二值化处理后的图像进行提取轮廓并生成中心点的过程中，首先，对图像进行高斯模糊，其次，计算梯度幅值和方向，然后，进行非最大值抑制，接着，使用一个高阈 值和一个低阈 值来区分边缘像素，最后，进行滞后边界跟踪。
优选的是，上述步骤2中，试管架相对于摄像头的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出，包括如下步骤：
步骤21：设图像坐标系中A点的坐标为（xa，ya），B点的坐标为（xb，yb），C点的坐标为（xc，yc），D点的坐标为（xd，yd），试管所在矩形的长AB的斜率为kAB，宽CD的斜率为kCD，内边框的长AB相对于外边框的长A’B’的倾斜角为θAB，内边框的宽CD相对于外边框的宽C’D’的倾斜角为θCD，则，
步骤22：取倾斜角θAB和θCD的平均值：
优选的是，上述步骤4中，将d号试管的位置从平面坐标系转换到摄像头坐标系，最终得到P在摄像头坐标中的坐标P’’包括如下步骤：
步骤41：由试管架相对于摄像头的旋转角θ引入旋转矩阵R：
步骤42：将坐标P经过旋转之后得到P’，则，
步骤43：加上试管架平面坐标系相对于摄像头坐标系的偏移量（xo，yo），得到最终P在摄像头坐标中的坐标P’’：
优选的是，使用气泵驱动注射器，气泵产生正压与负压分别对应注射器排出与吸入液体，关闭气泵则注射器不再吸取与排出试管内试剂，吸入或排出试剂的量与气泵打开时间成正比，设吸取与排出的液体量为Y，时间为T，常数K，压强系数P，则，
；其中，P为正数则排出液体，P为负数则吸入液体。
与现有技术相比，本发明具有如下的有益效果：
（1）本发明提供一种基于智能控制***的自动化验装置，该装置包含上位机控制***，机械臂主体，视觉识别***，末端执行装置。上位机控制***主要对整个装置进行***的控制；机械臂主体是整个装置的“身体”，控制整个装置的移动；视觉识别***为本装置的“眼睛”，通过它来确定目标试管的精确位置；末端执行装置为整个装置的执行部件，实现最后一步操作，吸进与排出目标化验试剂。整个自动化验装置的化验效率与准确度与以上各个部分密切相关，缺一不可，以上各个部件牵一发而动全身，只有每个部分都正常工作才能保证整个***的稳定性。本装置采用开放式控制，可实现机械臂移动，试管的识别，吸取与排出试剂，人机交互等工作。
（2）本发明提供一种基于智能控制***的自动化验装置，与传统设备相比具有以下优点：
减少了人力劳动，大大节约了化验成本，同时提高了化验效率，使得其他工作效率提高；工作时间远远长与人工劳动。
避免了化验人员直接接触有毒物质的危害，比传统化验方法安全很多，代替了许多不可避免的危险物质的化验操作。
本装置运用了自动视觉识别***，可以智能服从人为指令，更准确识别试管标号，精度较高。
视觉识别与机械臂控制***形成闭环控制，抗干扰性极强。
附图说明
图1为本发明的机械臂主体的结构图；
图2为本发明的基于智能控制***的自动化验装置的结构图；
图3为本发明的直角坐标系uov与XO1Y的关系示意图；
图4为本发明的试管架平面示意图；
图5为本发明的摄像头采集图像二值化示意图；
图6为本发明的标号后的试管架图像示意图；
图7为本发明的目标试管坐标由试管架平面坐标系变换到摄像头坐标系示意图；
图8为本发明的信号处理电路图。
附图标记：
1-机械臂主体；2-末端执行器；3-气泵；4-试管架；5-上位机控制***；6-第二伺服电机；7-大臂；8-第三伺服电机；9-小臂；10-联动关节；11-注射器；12-摄像头；13-第一伺服电机。
具体实施方式
下面结合附图和实施例对本发明提供的基于智能控制***的自动化验装置进行详细说明。
如图2所示，本发明提供的基于智能控制***的自动化验装置包括机械臂主体1、末端执行器2、气泵3、试管架4、上位机控制***5以及视觉识别***。
其中，试管架4用于固定试管，视觉识别***设置于机械臂主体1上，视觉识别***用于提供目标试管的坐标，并将坐标传输至上位机控制***5，上位机控制***5的输出端与机械臂主体1的输入端连接，上位机控制***5根据接收到的目标试管的坐标向机械臂主体1发送第一控制指令以控制机械臂主体1运动至目标试管位置，上位机控制***5的输出端还与气泵3的输入端连接，末端执行器2安装于机械臂主体1末端，末端执行器2用于排出与吸入设置于试管架4上试管中的待化验的试剂，末端执行器2与气泵3连接，在机械臂主体1的运动至目标试管位置后，上位机控制***5向气泵3发送第二控制指令以控制气泵3通过控制气压的正负以控制末端执行器2的工作，末端执行器2正下方为试管架4。
如图1所示，机械臂主体1包括第一伺服电机13、第二伺服电机6、大臂7、第三伺服电机8、小臂9以及联动关节10；末端执行器2包括注射器11和摄像头12。
其中，第一伺服电机13固定设置于工作平台上，第二伺服电机6与第一伺服电机13直接连接，大臂7的一端与第二伺服电机6相连，大臂7的另一端与第三伺服电机8连接，小臂9的一端与第三伺服电机8连接，小臂9的另一端与联动关节10的一端连接，联动关节10的另一端设置有注射器11，注射器11一侧设置有摄像头12，第一伺服电机13控制大臂7左右转动，第二伺服电机6控制大臂7前后转动，第三伺服电机8控制注射器11上下运动。
如图3所示，机械臂对试管操作之前首先要确定目标试管的位置，这个过程主要由两部分构成，分别是获取目标试管坐标以及目标试管坐标与世界坐标系下坐标的转换。
具体地，视觉识别***提供目标试管的坐标，包括以下步骤：
步骤1：在将摄像头12采集的图像经过灰度化、平滑、二值化、提取轮廓并生成中心点，建立一个以像素为单位的直角坐标系uov，每一像素的坐标(u，v)分别代表该像素在数组中的列数与行数，再建立一个物理单位的直角坐标系XO1Y，用来表示图像点的位置，并将直角坐标系XO1Y的原点定在摄像头的主点上，其中，x轴与u轴平行、y轴与v轴平行，uov坐标系的原点定在XO1Y坐标系的左上角，设O1在uov坐标系中的坐标为(u0，v0)，每一个像素在x轴与y轴方向上的物理尺寸为dx，dy，则图像中任意一个像素在两个坐标系下的坐标有如下关系：
x=(u-u0)dx，y=-(v-v0)dy，
转换为矩阵形式为：
如图4所示，ABCD是经过图像处理得到的***试管中心点拟合的矩形，O点是矩形的中点，以O点为原点建立直角坐标系，X轴平行于矩形的长，Y轴平行于矩形的宽。
步骤2：设ABCD是经过图像处理得到的***试管中心点拟合的矩形，O点是矩形的中点，以O点为原点建立直角坐标系，x轴平行于矩形的长，y轴平行于矩形的宽；设A’B’C’D’是摄像头12采集图像的外边框，
是其中点，试管架4相对于摄像头12的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出。
如图5所示，A’B’C’D’是摄像头采集图像的外边框，
是其中点，ABCD是试管架所在的矩形，试管架相对于摄像头的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出。
本***设计采用的是平面视觉，所以设计中考虑到平面视觉相关的二维坐标公式变化的相关特性，因为我们对装置的设计为摄像头轴线垂直于试管架平面，所以图像坐标系与世界坐标系平行，这样我们仅仅需要对其进行二维变换即可，二维坐标变换即旋转与平移，我们对处理过的图像进行参数计算，则可以得出试管架相对于摄像头的平移和旋转的数据量。
如图6所示，图4 为标号后的试管架图像。
步骤3：在试管架4的平面图像中，以矩形的中心点为原点建立直角坐标系，两个相邻试管的圆心的横向间距和纵向间距都为Δ，设d号试管在试管架上的第a行第b列，其中，试管架4最上面一行为第0行，试管架4最左边一列为第0列，a、b都为整型，设试管架4共6列3行，且试管以试管架4左上角第一个为1号试管，按照先从左往右，再从上到下依次排序，则，d号试管的位置P：
步骤4：将d号试管的位置从平面坐标系转换到摄像头坐标系，最终得到P在摄像头坐标中的坐标P’’，坐标P’’为目标试管的坐标。
具体地，上述步骤1中，将摄像头12采集的图像经过灰度化、平滑、二值化、提取轮廓并生成中心点包括如下步骤：
步骤11：将摄像头12采集的彩色图像转化成为灰度图像；
步骤12：在对上述灰度图像进行平滑处理的过程中，对图像应用高斯模糊进行噪声去除，减少伪边缘的识别度；
步骤13：在对上述经过平滑处理后的图像进行二值化处理的过程中，首先找到图像中所有像素的最大值和最小值，然后取中心点作为阈值，低于阈值的像素设为黑色，高于或等于阈值的像素设为白色；
步骤14：在对上述经过二值化处理后的图像进行提取轮廓并生成中心点的过程中，首先，对图像进行高斯模糊，其次，计算梯度幅值和方向，然后，进行非最大值抑制，接着，使用一个高阈 值和一个低阈 值来区分边缘像素，最后，进行滞后边界跟踪。
具体地，上述步骤2中，试管架4相对于摄像头12的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出，包括如下步骤：
步骤21：设图像坐标系中A点的坐标为（xa，ya），B点的坐标为（xb，yb），C点的坐标为（xc，yc），D点的坐标为（xd，yd），试管所在矩形的长AB的斜率为kAB，宽CD的斜率为kCD，内边框的长AB相对于外边框的长A’B’的倾斜角为θAB，内边框的宽CD相对于外边框的宽C’D’的倾斜角为θCD，则，
步骤22：取倾斜角θAB和θCD的平均值：
具体地，上述步骤4中，将d号试管的位置从平面坐标系转换到摄像头坐标系，最终得到P在摄像头坐标中的坐标P’’包括如下步骤：
步骤41：由试管架4相对于摄像头12的旋转角θ引入旋转矩阵R：
步骤42：将坐标P经过旋转之后得到P’，则，
步骤43：加上试管架平面坐标系相对于摄像头坐标系的偏移量（xo，yo），得到最终P在摄像头坐标中的坐标P’’：
如图7所示，目标试管坐标由试管架平面坐标系变换到摄像头坐标系。
具体地，使用气泵3驱动注射器11，气泵3产生正压与负压分别对应注射器11排出与吸入液体，关闭气泵3则注射器11不再吸取与排出试管内试剂，吸入或排出试剂的量与气泵3打开时间成正比，设吸取与排出的液体量为Y，时间为T，常数K，压强系数P，则，
；其中，P为正数则排出液体，P为负数则吸入液体。
更进一步地，由于在末端执行器2作业时的振动对本发明提供的基于智能控制***的自动化验装置的精度有巨大影响，现有技术中，对执行器的振动测试往往精度不高，在精密作业中，振动对本发明提供的基于智能控制***的自动化验装置的影响不可忽略。
因此，本发明提供的基于智能控制***的自动化验装置还包括设置于末端执行器2上的振动传感器，其中，振动传感器用于监测末端执行器2的振动信号，振动传感器的输出端与信号处理电路的输入端连接，信号处理电路依次对接收到的振动信号进行信号放大和信号滤波处理后将信号传输至上位机控制***5，上位机控制***5再将接收到的振动信号转换为振动值传输至与上位机控制***5连接的显示装置，由此，工作人员能够通过显示器精确获知末端执行器2的振动情况，在末端执行器2振动过大时，工作人员能够及时检查设备。
如图8所示，振动传感器用于监测末端执行器2的振动信号，将采集的振动信号转换为电流信号I0，并将电流信号I0传输至信号处理电路，V1为经过信号处理电路处理后的电压信号，信号处理电路包括信号放大单元和信号滤波单元，振动传感器的输出端与信号放大单元的输入端连接，信号放大单元的输出端与信号滤波单元的输入端连接，信号滤波单元的输出端与上位机控制***5的输入端连接。
信号放大单元包括集成运放A1-A2、电容C1-C4、三极管VT1-VT4和电阻R1-R10。
其中，振动传感器的输出端与电阻R1的一端连接，电阻R1的另一端与集成运放A1的反相输入端连接，集成运放A1的同相输入端接地，电阻R1的另一端与电容C1的一端连接，电容C2和电阻R2并联后的一端与电阻R2的另一端连接，电容C2和电阻R2并联后的另一端与所述信号滤波单元连接，电容C1的另一端与集成运放A1的输出端连接，集成运放A1的输出端与集成运放A2的输入端连接，电容C3的一端接地，电容C3的另一端与+15V电源连接，电容C4的一端接地，电容C4的另一端与-15V电源连接，电容C4的另一端还与电阻R4的一端连接，电阻R4的另一端与集成运放A2的V-端连接，电阻R4的另一端还与三极管VT4的基极连接，电阻R3的一端与集成运放A2的V+端连接，电阻R3的一端与三极管VT3的基极连接，电阻R3的一端还与三极管VT1的集电极连接，电阻R3的另一端与+15V电源连接，电阻R10的一端与三极管VT2的集电极连接，三极管VT2的集电极还与-15V电源连接，电阻R10的另一端与三极管VT4的发射极连接，电阻R9的一端与三极管VT2的基极连接，电阻R9的另一端与电阻R10的另一端连接，三极管VT2的集电极与三极管VT4的基极连接，电阻R8的一端接地，电阻R8的另一端与集成运放A2的输出端连接，电阻R8的另一端还与电阻R7的一端连接，电阻R7的另一端与三极管VT4的集电极连接，三极管VT4的集电极与三极管VT3的集电极连接，三极管VT3的基极与三极管VT1的集电极连接，电阻R6的一端与三极管VT1的基极连接，电阻R6的另一端与三极管VT3的集电极连接，电阻R5的一端与三极管VT1的集电极连接，电阻R5的另一端与电阻R6的另一端连接。
信号滤波单元包括电阻R11-R20、电容C5-C11以及集成运放A3-A6。
其中，信号放大单元的输出端与电阻R11的一端连接，电阻R11的另一端与电容C5的一端连接，电阻R15的一端接地，电阻R15的另一端与电阻R14的一端连接，电阻R15的另一端与集成运放A3的同相输入端连接，电阻R14的另一端与电阻R13的一端连接，电阻R14的另一端还与集成运放A4的输出端连接，电阻R13的另一端与集成运放A3的反相输入端连接，电阻R13的另一端与集成运放A4的反相输入端连接，电阻R13的另一端还与电容C7的一端连接，电容C7的另一端与集成运放A3的输出端连接，电容C7的另一端与电阻R12的一端连接，电阻R12的另一端与电容C6的一端连接，电阻R12的另一端还与集成运放A4的同相输入端连接，电容C6的另一端与电容C5的另一端连接，电容C5的另一端还与电容C8的一端连接，电阻R19的一端接地，电阻R19的另一端与电阻R18的一端连接，电阻R19的另一端与集成运放A5的同相输入端连接，电阻R18的另一端与电阻R17的一端连接，电阻R18的另一端还与集成运放A6的输出端连接，电阻R17的另一端与集成运放A5的反相输入端连接，电阻R17的另一端与集成运放A6的反相输入端连接，电阻R17的另一端还与电容C10的一端连接，电容C10的另一端与集成运放A5的输出端连接，电容C10的另一端与电阻R16的一端连接，电阻R16的另一端与电容C9的一端连接，电阻R16的另一端还与集成运放A6的同相输入端连接，电容C9的另一端与电容C8的另一端连接，电容C8的另一端还与电容C11的一端连接，电阻R20的一端接地，电阻R20的另一端与电容C11的另一端连接，电阻R20的另一端与上位机控制***5的输入端连接，信号滤波单元将电压信号V1传输至上位机控制***5。
上述实施方式中，信号处理电路的噪声在2.25nV以内，漂移为1.25μV/℃，集成运放A1的型号均为LT1056，集成运放A2的型号为LT1010,集成运放A3-A6的型号为LT1192，三极管VT1的型号均为2N3906，三极管VT2的型号均为2N3904，三极管VT3的型号均为MJE2955，三极管VT4的型号均为MJE3055。
在信号放大单元中，电阻R1的阻值为10kΩ，电阻R2的阻值为10kΩ，电阻R3的阻值为33Ω，电阻R4的阻值为33Ω，电阻R5的阻值为0.18Ω，电阻R6的阻值为1kΩ，电阻R7的阻值为100Ω，电阻R8的阻值为100Ω，电阻R9的阻值为1kΩ，电阻R10的阻值为0.18Ω，电容C1的电容值为22μF，电容C2的电容值为15pF，电容C3的电容值为22μF，电容C4的电容值为22μF。
由于振动传感器采集的信号较为微弱，容易被噪声覆盖/影响，因此，本实施例提供的信号放大单元的电路结构提供了一个抗噪、快速增加集成运放A2的输出功率，对于放大本发明中传感器采集的信号效果较佳，克服了现有技术中传感器采集精度不高的问题。
电阻R3和电阻R4采集集成运放A2的供电信号，其负载采用了接地的电阻R8。电阻R3和电阻R4上的压降偏置三极管VT3和VT4，另外，采用电阻R7形成闭合的反馈回路，以保障信号放大信号的稳定输出，通过电阻R2直接反馈到集成运放A1控制放大，三极管VT1和三极管VT2感测电阻R5和R10上的压降，可有效抑制噪声信号。
集成运放A1的稳定性通过电容C1使其滚降来保证，而电容C2的反馈电容微调边缘响应，本实施例中的信号放大单元中采用的三极管具有低频率响应，因此，在信号放大单元中不必再考虑进行额外的频率补偿。
信号放大单元的输出电压信号为V01。
在信号滤波单元中，电阻R15-R24的阻值、电容C10-C11的电容值为根据滤波需求进行设置。
本实施例中优选一组电阻R11-R20的阻值、电容C5-C11的电容值的值，其中，电阻R11的阻值为100kΩ，电阻R12的阻值为66.5kΩ，电阻R13的阻值为66.5kΩ，电阻R14的阻值为66.5kΩ，电阻R15的阻值为66.5kΩ，电阻R16的阻值为75kΩ，电阻R17的阻值为75kΩ，电阻R18的阻值为75kΩ，电阻R19的阻值为75kΩ，电阻R20的阻值为100kΩ，电容C5的电容值为5.161nF，电容C6的电容值为35.05nF，电容C7的电容值为10nF，电容C8的电容值为3.251nF，电容C9的电容值为12.03nF，电容C10的电容值为10nF，电容C11的电容值为6.505nF。
由于振动传感器采集的信号为微弱的电压信号，因而信号放大单元通过集成运放A1-A2、电容C1-C4、三极管VT1-VT4和电阻R1-R10对振动传感器输出的电流I0进行放大处理，由集成运放A1-A2、电容C1-C4、三极管VT1-VT4和电阻R1-R10构成的信号放大单元只有1.25μV/℃的漂移、2μV以内的偏移、100pA偏置电流和0.1Hz到10Hz宽带内2.25nV的噪声。其中，信号滤波单元使用电阻R11-R20、电容C5-C11以及集成运放A3-A6对经过放大后的电信号进行滤波处理，从而提高了振动检测的精度。
本发明提供一种基于智能控制***的自动化验装置，该装置包含上位机控制***，机械臂主体，视觉识别***，末端执行装置。上位机控制***主要对整个装置进行***的控制；机械臂主体是整个装置的“身体”，控制整个装置的移动；视觉识别***为本装置的“眼睛”，通过它来确定目标试管的精确位置；末端执行装置为整个装置的执行部件，实现最后一步操作，吸进与排出目标化验试剂。整个自动化验装置的化验效率与准确度与以上各个部分密切相关，缺一不可，以上各个部件牵一发而动全身，只有每个部分都正常工作才能保证整个***的稳定性。本装置采用开放式控制，可实现机械臂移动，试管的识别，吸取与排出试剂，人机交互等工作。
最后所应说明的是，以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，对本发明的技术方案进行修改或者等同替换，都不脱离本发明技术方案的精神和范围，其均应涵盖在本发明的权利要求范围当中。
Claims (5)
1.一种基于智能控制***的自动化验装置，其特征在于，所述基于智能控制***的自动化验装置包括机械臂主体（1）、末端执行器（2）、气泵（3）、试管架（4）、上位机控制***（5）以及视觉识别***；其中，试管架（4）用于固定试管，所述视觉识别***设置于所述机械臂主体（1）上，所述视觉识别***用于提供目标试管的坐标，并将坐标传输至所述上位机控制***（5），所述上位机控制***（5）的输出端与所述机械臂主体（1）的输入端连接，所述上位机控制***（5）根据接收到的目标试管的坐标向所述机械臂主体（1）发送第一控制指令以控制所述机械臂主体（1）运动至目标试管位置，所述上位机控制***（5）的输出端还与所述气泵（3）的输入端连接，所述末端执行器（2）安装于所述机械臂主体（1）末端，所述末端执行器（2）用于排出与吸入设置于所述试管架（4）上试管中的待化验的试剂，所述末端执行器（2）与所述气泵（3）连接，在所述机械臂主体（1）的运动至目标试管位置后，所述上位机控制***（5）向所述气泵（3）发送第二控制指令以控制所述气泵（3）通过控制气压的正负以控制所述末端执行器（2）的工作，所述末端执行器（2）正下方为所述试管架（4）；
所述机械臂主体（1）包括第一伺服电机（13）、第二伺服电机（6）、大臂（7）、第三伺服电机（8）、小臂（9）以及联动关节（10）；所述末端执行器（2）包括注射器（11）和摄像头（12）；其中，所述第一伺服电机（13）固定设置于工作平台上，所述第二伺服电机（6）与所述第一伺服电机（13）直接连接，所述大臂（7）的一端与所述第二伺服电机（6）相连，所述大臂（7）的另一端与所述第三伺服电机（8）连接，所述小臂（9）的一端与所述第三伺服电机（8）连接，所述小臂（9）的另一端与所述联动关节（10）的一端连接，所述联动关节（10）的另一端设置有所述注射器（11），所述注射器（11）一侧设置有摄像头（12），所述第一伺服电机（13）控制所述大臂（7）左右转动，所述第二伺服电机（6）控制所述大臂（7）前后转动，所述第三伺服电机（8）控制所述注射器（11）上下运动；
所述视觉识别***提供目标试管的坐标，包括以下步骤：
步骤1：在将所述摄像头（12）采集的图像经过灰度化、平滑、二值化、提取轮廓并生成中心点，建立一个以像素为单位的直角坐标系uov，每一像素的坐标(u，v)分别代表该像素在数组中的列数与行数，再建立一个物理单位的直角坐标系XO1Y，用来表示图像点的位置，并将直角坐标系XO1Y的原点定在摄像头的主点上，其中，x轴与u轴平行、y轴与v轴平行，uov坐标系的原点定在XO1Y坐标系的左上角，设O1在uov坐标系中的坐标为(u0，v0)，每一个像素在x轴与y轴方向上的物理尺寸为dx，dy，则图像中任意一个像素在两个坐标系下的坐标有如下关系：
x=(u-u0)dx，y=-(v-v0)dy，
转换为矩阵形式为：
步骤2：设ABCD是经过图像处理得到的***试管中心点拟合的矩形，O点是矩形的中点，以O点为原点建立直角坐标系，x轴平行于矩形的长，y轴平行于矩形的宽；设A’B’C’D’是所述摄像头（12）采集图像的外边框，
是其中点，所述试管架（4）相对于所述摄像头（12）的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出；
步骤3：在所述试管架（4）的平面图像中，以矩形的中心点为原点建立直角坐标系，两个相邻试管的圆心的横向间距和纵向间距都为Δ，设d号试管在试管架上的第a行第b列，其中，所述试管架（4）最上面一行为第0行，所述试管架（4）最左边一列为第0列，a、b都为整型，设所述试管架（4）共6列3行，且试管以所述试管架（4）左上角第一个为1号试管，按照先从左往右，再从上到下依次排序，则，d号试管的位置P：
步骤4：将d号试管的位置从平面坐标系转换到摄像头坐标系，最终得到P在摄像头坐标中的坐标P’’，坐标P’’为目标试管的坐标。
2.根据权利要求1所述的基于智能控制***的自动化验装置，其特征在于，上述步骤1中，将所述摄像头（12）采集的图像经过灰度化、平滑、二值化、提取轮廓并生成中心点包括如下步骤：
步骤11：将所述摄像头（12）采集的彩色图像转化成为灰度图像；
步骤12：在对上述灰度图像进行平滑处理的过程中，对图像应用高斯模糊进行噪声去除，减少伪边缘的识别度；
步骤13：在对上述经过平滑处理后的图像进行二值化处理的过程中，首先找到图像中所有像素的最大值和最小值，然后取中心点作为阈值，低于阈值的像素设为黑色，高于或等于阈值的像素设为白色；
步骤14：在对上述经过二值化处理后的图像进行提取轮廓并生成中心点的过程中，首先，对图像进行高斯模糊，其次，计算梯度幅值和方向，然后，进行非最大值抑制，接着，使用一个高阈 值和一个低阈 值来区分边缘像素，最后，进行滞后边界跟踪。
3.根据权利要求2所述的基于智能控制***的自动化验装置，其特征在于，上述步骤2中，所述试管架（4）相对于所述摄像头（12）的旋转角θ可以通过计算线AB的斜率或者线CD的斜率得出，包括如下步骤：
步骤21：设图像坐标系中A点的坐标为（xa，ya），B点的坐标为（xb，yb），C点的坐标为（xc，yc），D点的坐标为（xd，yd），试管所在矩形的长AB的斜率为kAB，宽CD的斜率为kCD，内边框的长AB相对于外边框的长A’B’的倾斜角为θAB，内边框的宽CD相对于外边框的宽C’D’的倾斜角为θCD，则，
步骤22：取倾斜角θAB和θCD的平均值：
4.根据权利要求3所述的基于智能控制***的自动化验装置，其特征在于，上述步骤4中，将d号试管的位置从平面坐标系转换到摄像头坐标系，最终得到P在摄像头坐标中的坐标P’’包括如下步骤：
步骤41：由所述试管架（4）相对于所述摄像头（12）的旋转角θ引入旋转矩阵R：
步骤42：将坐标P经过旋转之后得到P’，则，
步骤43：加上试管架平面坐标系相对于摄像头坐标系的偏移量（xo，yo），得到最终P在摄像头坐标中的坐标P’’：
5.根据权利要求4所述的基于智能控制***的自动化验装置，其特征在于，使用所述气泵（3）驱动所述注射器（11），所述气泵（3）产生正压与负压分别对应所述注射器（11）排出与吸入液体，关闭所述气泵（3）则所述注射器（11）不再吸取与排出试管内试剂，吸入或排出试剂的量与所述气泵（3）打开时间成正比，设吸取与排出的液体量为Y，时间为T，常数K，压强系数P，则，
；其中，P为正数则排出液体，P为负数则吸入液体。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910557429.3A CN110244071B (zh) | 2019-06-25 | 2019-06-25 | 一种基于智能控制***的自动化验装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910557429.3A CN110244071B (zh) | 2019-06-25 | 2019-06-25 | 一种基于智能控制***的自动化验装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110244071A CN110244071A (zh) | 2019-09-17 |
| CN110244071B true CN110244071B (zh) | 2022-12-23 |
Family
ID=67889390
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910557429.3A Active CN110244071B (zh) | 2019-06-25 | 2019-06-25 | 一种基于智能控制***的自动化验装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110244071B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111015651A (zh) * | 2019-11-26 | 2020-04-17 | 广东省医疗器械研究所 | 一种新型的在线水质分析***及其实现方法 |
| CN112474391B (zh) * | 2020-11-16 | 2021-10-29 | 基点生物科技(成都)有限公司 | 一种基于视觉辅助验证的冻存管挑选方法 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101944347B1 (ko) * | 2010-11-23 | 2019-04-17 | 앤드류 알리안스 에스. 에이. | 피펫의 프로그래밍 가능한 조작을 위한 장치 및 방법 |
| CN203858256U (zh) * | 2014-04-04 | 2014-10-01 | 珠海森龙生物科技有限公司 | 加样*** |
| CN108187781A (zh) * | 2017-12-30 | 2018-06-22 | 深圳市阿瑟医疗机器人有限公司 | 试管架移动***及智能实验室 |
| CN208350820U (zh) * | 2018-06-26 | 2019-01-08 | 长沙理工大学 | 一种快速的自动加样装置 |
-
2019
- 2019-06-25 CN CN201910557429.3A patent/CN110244071B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN110244071A (zh) | 2019-09-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111791239B (zh) | 一种结合三维视觉识别可实现精确抓取的方法 | |
| CN110244071B (zh) | 一种基于智能控制***的自动化验装置 | |
| US7957583B2 (en) | System and method of three-dimensional pose estimation | |
| WO2023056670A1 (zh) | 复杂光照条件下基于视触融合的机械臂自主移动抓取方法 | |
| CN111611989B (zh) | 一种基于自主机器人的多目标精准定位识别方法 | |
| TW201830184A (zh) | 控制裝置、機器人及機器人系統 | |
| CN108544531B (zh) | 一种基于视觉标定的自动化验机械臂装置、控制***及其控制方法 | |
| CN111483803B (zh) | 控制方法、抓取***和存储介质 | |
| CN110298885B (zh) | 一种非光滑类球体目标的立体视觉识别方法和定位夹持检测装置及其应用 | |
| CN106003119A (zh) | 吸取式机械手的物体抓取方法及物体抓取*** | |
| CN111251336A (zh) | 一种基于视觉定位的双臂协同智能装配*** | |
| CN114454174B (zh) | 机械臂动作捕捉方法、介质、电子设备及*** | |
| CN112907586A (zh) | 基于视觉的机械臂控制方法、装置、***和计算机设备 | |
| US20160368150A1 (en) | Robot, control device, and control method | |
| CN116872216B (zh) | 一种基于有限时间控制的机器人视觉伺服作业方法 | |
| Boby | Hand-eye calibration using a single image and robotic picking up using images lacking in contrast | |
| Pedari et al. | Spatial shape estimation of a tendon-driven continuum robotic arm using a vision-based algorithm | |
| CN111437033B (zh) | 一种用于血管介入手术机器人***的虚拟传感器 | |
| EP3495096B1 (de) | Mobiler kommissionierroboter und verfahren zu seinem betrieb | |
| CN117817671B (zh) | 基于视觉引导的机器人***及机器人***校准方法 | |
| CN107607539B (zh) | 一种连杆胀断面质量视觉检测装置和检测方法 | |
| CN114800550B (zh) | 基于混合绳驱机器人的医疗器械辅助拾取方法及结构 | |
| CN216979087U (zh) | 膜片钳记录分析*** | |
| CN113524147B (zh) | 一种基于3d相机的工业机器人示教***及方法 | |
| Nan et al. | Depth detection for a stereo cell micro-injection system with dual cameras |
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 | ||
| TA01 | Transfer of patent application right | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20221206 Address after: 401121 No. 3-2, 1st floor, zone 2-2, Jupiter science and Technology Development Center (Jupiter), Gaoxin Park, Dazhulin street, Liangjiang New Area, Chongqing Applicant after: Chongqing Ouluo Intelligent Control System Co.,Ltd. Address before: 211305 Gangkou kindergarten, zhuanqiang Town, Gaochun District, Nanjing City, Jiangsu Province Applicant before: SUZHOU PULITE ELECTRONICS TECHNOLOGY Co.,Ltd. |
|
| GR01 | Patent grant | ||
| GR01 | Patent grant |