[发明专利]生猪疫苗注射机器人以及疫苗注射方法

说明书

本发明涉及一种生猪疫苗注射机器人以及疫苗注射方法，其解决了现有人工采用打针的方式对生猪注射疫苗劳动强度大，人工成本高，注射效率低，容易发生漏打、误打的技术问题，其包括轮式移动平台、六自由度协作机械臂、无针头注射器、RGB‑D相机、相机支架以及控制系统，六自由度协作机械臂与轮式移动平台连接，无针头注射器设有手柄和注射头，手柄与六自由度协作机械臂的末端法兰固定连接；相机支架与六自由度协作机械臂的末端连接，RGB‑D相机与相机支架固定连接；轮式移动平台设有移动平台主控制器、电机驱动器，电机驱动器与移动平台主控制器连接。其可广泛应用于畜牧业的动物疫病防控技术领域。

技术领域

本发明涉及智能畜牧业技术领域，具体而言，涉及一种生猪疫苗注射机器人以及疫苗注射方法。

背景技术

畜牧业是关系国计民生的重要产业，动物疫病的防控是关键工作，随着人工智能在畜牧业越来越广泛的应用，对动物防疫的防控提出了更高的要求。以生猪养殖为例，目前主要是人工采用打针的方式对生猪注射疫苗，由于生猪数量非常大，导致劳动强度非常大，人工成本高，注射效率低，也容易发生漏打、误打的情况，严重影响疫病防控管理，因此，如何降低人工成本，减少人畜接触，提高注射效率，保证注射质量已成为本领域技术人员亟待解决的技术问题。

发明内容

本发明就是为了解决现有人工采用打针的方式对生猪注射疫苗劳动强度大，人工成本高，注射效率低，容易发生漏打、误打的技术问题，提供大幅降低人工成本，提高注射效率，保证注射质量，减少人畜接触的生猪疫苗注射机器人以及疫苗注射方法。

本发明提供一种生猪疫苗注射机器人，包括轮式移动平台、六自由度协作机械臂、无针头注射器、RGB-D相机、相机支架以及控制系统，六自由度协作机械臂与轮式移动平台连接，无针头注射器设有手柄和注射头，手柄与六自由度协作机械臂的末端法兰固定连接；相机支架与六自由度协作机械臂的末端连接，RGB-D相机与相机支架固定连接；轮式移动平台设有移动平台主控制器、电机驱动器，电机驱动器与移动平台主控制器连接；

控制系统包括上位机、RFID电子耳标、RFID耳标识别器、机械臂控制器、网关和云平台，机械臂控制器设置在轮式移动平台中，RFID耳标识别器通过网关与云平台通信，上位机通过网关与云平台通信，机械臂控制器与上位机连接，六维力传感器与上位机连接，RGB-D相机与上位机连接，移动平台主控制器与上位机连接。

优选地，生猪疫苗注射机器人还包括六维力传感器，六维力传感器与六自由度协作机械臂的末端法兰连接，无针头注射器的手柄与六维力传感器的连接法兰固定连接。

本发明还提供一种应用生猪疫苗注射机器人的疫苗注射方法，包括以下步骤：

步骤S101，将RFID耳标识别器连接于圈舍内的饮水槽处，将RFID电子耳标固定在猪只的耳朵上；RFID电子耳标中有ID信息和位置信息；RFID耳标识别器实时将从RFID电子耳标采集到的ID信息和位置信息通过WIFI网络上传给云平台；

步骤S102，使生猪疫苗注射机器人运动到圈舍附近的等待位置，此时六自由度协作机械臂处于初始位姿；

步骤S103，上位机通过WIFI网络访问云平台，查询云平台中的ID信息和位置信息；

步骤S104，判断是否查询到ID信息和位置信息，如果是则进入步骤S105，否则返回步骤S103；

步骤S105，上位机从云平台获取待注射猪只的ID信息和位置信息；

步骤S106，上位机发送运动控制指令给轮式移动平台的移动平台主控制器；

步骤S107，平台主控制器根据运动控制指令生成电机驱动信号，并将电机驱动信号发送给轮式移动平台的电机驱动器，电机驱动器驱动轮式移动平台中用于驱动轮子的电机工作，使轮式移动平台移动到目标圈舍内，轮式移动平台移动到正在饮水的猪只旁边；