本文设计了一种基于51单片机的核酸采样机械臂运动控制系统，系统由机械臂模块、消杀模块、样本保存模块、语音引导模块和照明模块等5个模块组成，各模块之间相互配合，共同完成核酸采集与样品保存过程。控制思想是通过计算机语言来调节PWM输出占空比产生控制电压，由控制电压对机械臂的舵机进行控制，同时配合传感器最终实现在一定范围内对核酸被采样人员进行自动化核酸采集。 In this paper, a motion control system of nucleic acid sampling robot arm based on 51 microcon-troller is designed. The system consists of five modules, namely, robot arm module, kill module, sample preservation module, voice guidance module and lighting module. All modules cooperate with each other to complete the nucleic acid collection and sample preservation process. The con-trol idea is to generate control voltage by adjusting PWM output duty ratio through computer language, and control the steering gear of the robot arm by the control voltage. At the same time, the sensor is used to realize the automatic nucleic acid collection of nucleic acid sampling personnel within a certain range.
本文设计了一种基于51单片机的核酸采样机械臂运动控制系统，系统由机械臂模块、消杀模块、样本保存模块、语音引导模块和照明模块等5个模块组成，各模块之间相互配合，共同完成核酸采集与样品保存过程。控制思想是通过计算机语言来调节PWM输出占空比产生控制电压，由控制电压对机械臂的舵机进行控制，同时配合传感器最终实现在一定范围内对核酸被采样人员进行自动化核酸采集。
机械臂，51单片机，舵机控制，咽拭子，核酸检测，口腔采样
Menghan Liu, Guofen Chen, Shuangwei Wang, Taiping Chen, Keyu Yang, Feihan Liu, Yanlin Jiao, Shengping Zhao*
College of Engineering, Yuxi Normal University, Yuxi Yunnan
Received: Nov. 23rd, 2023; accepted: Jan. 4th, 2024; published: Mar. 14th, 2024
In this paper, a motion control system of nucleic acid sampling robot arm based on 51 microcontroller is designed. The system consists of five modules, namely, robot arm module, kill module, sample preservation module, voice guidance module and lighting module. All modules cooperate with each other to complete the nucleic acid collection and sample preservation process. The control idea is to generate control voltage by adjusting PWM output duty ratio through computer language, and control the steering gear of the robot arm by the control voltage. At the same time, the sensor is used to realize the automatic nucleic acid collection of nucleic acid sampling personnel within a certain range.
Keywords:Mechanical Arm, 51 Single-Chip Microcomputer, Steering Gear Control, Throat Swabbing, Nucleic Acid Testing, Oral Sampling
Copyright © 2024 by author(s) and beplay安卓登录
This work is licensed under the Creative Commons Attribution International License (CC BY 4.0).
http://creativecommons.org/licenses/by/4.0/
当前，机械臂的应用技术已逐渐涉及医疗领域 [
目前，国内外公司和机器人研发机构开发的用于新冠病毒的防控工作的机器人产品，主要集中在消毒、配送和远程会诊等方面，核酸采样机器人市场仍处于发展初期，尚未实现大规模应用，研究方向主要包括机器人技术发展、核酸采样方法、传感器与检测技术、消毒与防护措施、实验与应用研究、法规与伦理考虑等 [
该方案是基于51单片机设计的一种简单自动核酸采集机械臂装置，主要有硬件设计和软件设计两部分，以KPZ51为控制核心，系统由机械臂模块、语音引导模块、样本保存模块、照明模块和消杀模块构成。机械臂模块：51单片机综合分析系统状态和反馈信号后控制舵机完成指定动作。语音模块：既可以引导被采样者完成采样，又可以进行指令控制。样品保存模块：用以保存样品。消杀模块：在每次采样结束后，消杀模块会对机械臂进行消毒杀菌，保障采样过程的安全性，避免交叉传染。此外，我们在机械臂上安装了照明灯，为一条独立电路，用作照明模块，在光线较暗的情况下，被采样者可以按照提示在采样前手动打开照明灯。本设计主要是通过以机械臂夹取棉签模拟完成核酸采样与保存，设计出合理的旋转角度，夹取力度等参数，从而设定出机械臂系统控制参数。系统结构图如图1所示。
图1. 系统结构图
系统主电路图如图2所示。其中手柄接口配合红外接口，可实现对机械臂的遥感控制，PWM接口设置为六个分别连接六个舵机，下排白色接口为传感器接口和红外接口，上排六个白色接口用于单独引线连接语音模块，消杀模块，照明模块则单独设计电源，在单片机上方设置一个USB接口可用于备用：进行上机位操作，程序输入和获取实时工作信息等提高操作的可靠性。
图2. 系统底板图
系统核心部分为KPZ51主单片机，实物接线图中红色部分为51单片机。它具有成本低，功率高的优点，此外51单片机一种8位的微控制器，大量应用在嵌入式系统和低功耗设备中。利用51可以实验对机械臂的多样化控制，一是结合语音模块进行简单指令控制，二是结合计算机语音的程序控制，三是利用利用ps2遥感控制。
机械臂的组成主要包含舵机、机械臂本体、机械爪和传感器等，具有安全性好等优势，多用于工业生产中，其系统原理框图如图3。来自主电路的输出信号传入机械臂模块，分别进过微型处理器，功率放大电路进入舵机，由舵机转动带动机械臂本体运动，并与本体的输出信号构成闭环系统。本模块实现的功能是：在给定采集信号后，机械爪在六号舵机的驱动下夹取棉签，并配合其余转轴进行核酸的采样，在完成采样后，机械臂将采样的咽拭子放到样品保存模块中，完成一次采样后机械臂将回到初始位置。机械臂的运动速度是根据各个分任务的不同区间来分别设置速度值。在距离人较远的自由空间中，为了节省采样时间，速度设置为最快；在与机械臂插拔的接触操作过程中，速度与自由空间相比是较慢的；在进入人体口腔内进行采样的过程中，速度是最慢的，一方面是为了确保不会对人体口腔造成伤害，另一方面是为了保证咽拭子采样的质量。此外，机械臂末端安装传感器，可以实时检测与口腔内壁的接触力，从而保证不会对人体口腔造成伤害。
图3. 机械臂控制原理图
本设计选用6自由度的机械臂，机械臂外形如图4所示，1号舵机控制底座的旋转，2号舵机为大臂的转动，3号舵机为小臂的转动，该三个舵机可以用做确定机械臂的空间位置；4号舵机为手腕的上下摆动，5号舵机为手腕的左右摆动，6号舵机可控制的张合。
图4. 机械臂模型图
舵机是一种伺服电机，是机械臂转动控制的执行机构，一般由控制电路、马达、齿轮组、传感器组成。其工作原理是当PWM信号输入后与传感器反馈的转速信号形成偏差信号进入控制电路，控制电路输出电压对直流电机进行转动调控。在不同的脉冲宽度下对应有不同的旋转角度，一般情况下，脉冲宽度部分一般为0.5 ms~2.5 ms，在给定范围内的角度控制脉冲触发，总间隔为2 ms。当脉冲宽度为1.5 ms时，舵机旋转至中间角度，大于1.5 ms时舵机旋转角度增大，小于1.5 ms时舵机旋转角度减小。舵机分90˚、180˚、270˚和360˚的舵机，以180˚的舵机为例来看看脉冲宽度与角度的关系，当输入周期为20 ms的脉冲信号时，在第一个脉冲作用下，其脉冲宽度为0.5 ms会对应产生一个舵机输出轴转角为−90度，接着第二个脉冲宽度为1 ms时对应的输出为−45˚，以此类推，每0.5 ms宽度对应一个45˚的输出轴转角。
信息交流离不开语音传递 [
| 语音模块基本指令表 | |||
|---|---|---|---|
| 命令词 | 回复语 | 发出指令 | |
| 语音引导 | 小灵，小灵 | 我在\你说\有什么可以帮助您 | $WAKE! |
| 机械臂 动作控制 | 夹取\抓取\拿起\闭合手 | 收到，夹取 | $JQ! |
| 放下\放置\张开手 | 收到，放下 | $FX! | |
| 前抓\夹前面 | 收到，夹取前方物体 | $QC! | |
| 右抓\夹右边 | 收到，夹取左侧物体 | $ZC! | |
| 左抓\夹左边 | 收到，夹取右侧物体 | $YC! | |
| 前放\放前面\放到前面 | 收到，将物体放置在前方 | $QP! | |
| 左放\放左边\放到左边 | 收到，将物体放置在左侧 | $ZP! | |
| 右放\放右边\放到右边 | 收到，将物体放置在右侧 | $YP! | |
| 直立 | 收到，直立 | $DJR! | |
| 蜷缩 | 收到，蜷缩 | $QS! | |
表1. 语音模块基本指令
消杀模块是利用紫外线灯对机械臂工作环境进行消毒杀菌。故本模块选用基于Far UV-C (远紫外线)的消毒技术，即200~230 nm波段的短波UV (紫外线)作为光源，固定在机械臂旁边，在机器手臂进行下一轮采样时，先进行灭菌处理消毒手段，可以减少交叉感染。据Far UV-C对流感病毒、冠状病毒的杀菌有效性研究显示：该项技术对于冠状病毒消杀效果良好，且成为近年来受到高度关注的能杀菌消毒又对人体安全无害的热点技术。在完成核酸采集工作后机械臂Far UV-C消毒灯对核酸检测环境进行照射消毒，以此减少交叉感染的风险。在实际采样过程中采样人群之间一般会保持一定距离，且采样的人员较多，因此消杀模块灯的使用面积较小，使用频率高，在本模块设计中选用小功率光源进行安装 [
储存样本的模块主要由灭活病毒保存液组成在采样后机械臂会将样本放入装有红色药水的灭活保护液内。保存选取常温保存的方式，需要注意的是咽拭子的常温保存不得超过4小时，需要在有效时间送往实验室以保证结果的准确性。
由于病毒的爆发存在偶然性，在面对突发状况时就需要及时进行核酸检测，因此面对光线较暗的环境时，机械臂很难准确感应到检测位置来完成采样工作，为了弥补这一缺点，可以采用无电解电容照明LED驱动装置 [
此模块设计选取Keil 5为开发软件，采用C语言和开源代码设计出如图5所示的系统主程序流程图。其中，定义初始条件为机械臂完全直立状态(垂直于底座)且被采样者需要处于指定窗口。当主程序进入工作状态后，控制器会先读取传感器反馈的相关参数判断是否可以进入下一环节，若不满足条件系统会对对机械臂初始状态进行校验和对被采样者进行语音提醒，当满足进入条件时，系统会根据被采样者发出的相关指令进行操作，并在接下来的每个环节进行实时语音播报(图中未画出)，最终完成一个采样操作循环。
图5. 系统主程序流程图
系统可根据采样人员的不同的指令对出相同的响应。当系统接收到被采样者按下“开始采样”按钮的信息，或读取到采样语音指令后，会进入下一环节并在该环节判断与被采样者口腔之间的直线距离，随后做出相应处理，若机械臂距被采样者直线距离较远，舵机则以高速档运行从而加快采样速度；若机械臂离被采样者距离较近，舵机则选择低速挡转动以减小安全隐患。舵机旋转到固定角度时在上机位显示状态信息，随后处理器和控制器判断棉签与口腔接触力，根据接触力调整采样流程，依次进入口腔取样、消杀操作，最后采样完毕回到初始状态。
基于51单片机的机械臂设计具有自动化、高效化、精确化的特点，可实现对核酸样品的自动采集、存储和运输，具有灵活性高，成本低，功耗小，可维护等优势，对于提高核酸采样效率和质量具有重要意义，其推广使用不仅能缓解医护人员短缺的难题，还能降低病毒感染的风险，在我国疫情防控领域的发展前景十分广阔。可以减轻医护人员的工作强度和精神压力，提高采样效率。此外，随着智能自动化时代发展趋势，此设备在其他行业也会有极大发展空间。
该机械臂装置是一种主要针对口腔内核酸检测而开发的自动化系统。整体上包括机械臂模块、语音引导模块、消杀模块、照明模块和样本保存模块，适应包括酒店、车站、社区、医院等在内的多个场景。但是，由于该系统还未对人体进行过取样，所以不能给出与取样精度有关的数据。在此基础仍需要对机械臂采样、保存过程进行进一步完善，以提高采样的精确度。
大学生创新创业训练项目编号(2022A026; S202211390013)。
刘孟函,陈国芬,王双维,陈太平,杨可宇,刘霏函,角妍林,赵盛萍. 基于51单片机的核酸采样机械臂设计Design of Nucleic Acid Sampling Robot Arm Based on 51 Single-Chip Microcomputer[J]. 仪器与设备, 2024, 12(01): 18-24. https://doi.org/10.12677/IaE.2024.121003
https://doi.org/10.3969/j.issn.1671-3141.2020.70.146
https://doi.org/10.12138/j.issn.1671-9638.20217478