专利名称：定量抽吸机器人及其控制系统的制作方法
技术领域：
本发明涉及配置输液用药液的技术领域，具体地讲，是指一种定量抽吸(抽取、注射)机器人及其控制系统。
背景技术：
众所周知，人们 生病时，需要通过医疗来治愈，现有的医疗手段，除了喝药、打针，还有输液等，在对病人进行输液时，需要将安瓿瓶内的药液、粉剂瓶内的药粉与母液进行混合，然后，将母液中的药品输入病人体内。目前，中国在制备药物的技术领域，基本都是人工配药，S卩，病人在医生那开药后，先去药房取药，需要注射的药，拿到注射科去，护理人员根据医生的药单，先核对药方和药品是否一致，然后，再检查药品的品质，有无漏气之类的，再对安瓿瓶进行切割，消毒，再检索注射器包装，利用注射器进行抽取，即将安瓿瓶内的药品注射入母液中；若还有粉剂瓶，其会再将粉剂瓶进行消毒，将母液注入粉剂瓶中，摇晃均匀后，再将药品注入母液中。由上可知，由于目前的配药均由人工完成，容易造成药液污染。另外，有些有毒的药剂，有可能对医护工作者造成身体伤害。
发明内容
本发明的目的在于提供一种能精确的实现药液的抽取，以使配药过程自动化的定量抽吸机器人及其控制系统。为实现上述目的，本发明采用如下技术方案:—种定量抽吸机器人的控制系统，用于对定量抽吸机器人在配制静脉输液用药液的过程进行控制，该控制系统，包括位姿接收模块、位姿计算单元及运动控制单元；所述的位姿接收模块，用于接收药剂所在的目标位姿(位置姿态)，并将药剂的位姿信息传输给位姿计算单元；所述的位姿计算单元，接收药剂的位姿信息，进行机器人的逆向运动学解算，得到定量吸注机器人的各个控制轴的目标运行位置，并将各控制轴目标位置信息传输给所述的运动控制单元；所述的运动控制单元接收各控制轴目标位置信息下发给所述的定量抽吸机器人各关节执行单元。 优选地，上述的位姿计算单元，其是通过运动学正解的方式进行位姿计算，方程表达式如下:
权利要求
1.一种定量抽吸机器人的控制系统，用于对定量抽吸机器人在配制静脉输液用药液的过程进行控制，其特征在于:该控制系统，包括位姿接收模块、位姿计算单元及运动控制单元; 所述的位姿接收模块，用于接收药剂所在的目标位姿，并将药剂的位姿信息传输给位姿计算单元； 所述的位姿计算单元，接收药剂的位姿信息，进行机器人的逆向运动学解算，得到定量吸注机器人的各个控制轴的目标运行位置，并将各控制轴目标位置信息传输给所述的运动控制单兀； 所述的运动控制单元接收各控制轴目标位置信息下发给所述的定量抽吸机器人各关节执行单元。
2.根据权利要求1所述的定量抽吸机器人的控制系统，其特征在于:所述的位姿计算单元，其是通过运动学正解的方式进行位姿计算，方程表达式如下:
3.根据权利要求1所述的定量抽吸机器人的控制系统，其特征在于:所述的位姿计算单元，其是通过运动学反解的方式进行位姿计算，方程表达式如下:
4.根据权利要求1、2或3所述的定量抽吸机器人的控制系统，其特征在于:所述的位姿计算单元，其计算所述的定量抽取机器人对母液的抽吸，采用的如下方程表达式得出定量抽取机器人从当前位置需要运行到目前位置:
5.一种定量抽吸机器人，其特征在于:其包括权利要求1 4任一所述的控制系统及执行机构，所述的执行机构在所述的控制系统的控制下进行定量抽取操作，所述的执行机构为六自由度机构，其包括平移组件、旋转组件及抽取组件，所述的抽取组件装设在所述的旋转组件上，其在旋转组件的带动下转动，所述的旋转组件装设在所述的平移组件上，其在所述的平移组件上平移， 所述的抽取组件上设有注射器。
全文摘要
本发明公开了一种定量抽吸机器人及其控制系统，用于配制静脉输液用药液，该控制系统，包括位姿接收模块、位姿计算单元及运动控制单元；位姿接收模块，用于接收药剂所在的目标位姿，并将药剂的位姿信息传输给位姿计算单元；位姿计算单元，接收药剂的位姿信息，进行机器人的逆向运动学解算，得到定量吸注机器人的各个控制轴的目标运行位置，并将各控制轴目标位置信息传输给所述的运动控制单元；运动控制单元接收各控制轴目标位置信息下发给所述的定量抽吸机器人各关节执行单元。本发明，能精确的控制定量抽取机器人的执行机构，自动化的实现药剂的定量抽取，避免了药液污染的发生。另外，也避免了有些有毒的药剂，有可能对医护工作者造成身体伤害的可能。
文档编号B01F3/12GK103083186SQ201110331108
公开日2013年5月8日 申请日期2011年10月27日 优先权日2011年10月27日
发明者刘葆春, 王喆 申请人:深圳市卫邦科技有限公司