一种医疗机械臂的控制方法及装置
基本信息
申请号 | CN201410489915.3 | 申请日 | - |
公开(公告)号 | CN104260095A | 公开(公告)日 | 2015-01-07 |
申请公布号 | CN104260095A | 申请公布日 | 2015-01-07 |
分类号 | B25J9/18(2006.01)I | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 丁大民;邓琛;王朝斌 | 申请(专利权)人 | 上海慧勤医疗器械有限公司 |
代理机构 | 上海科盛知识产权代理有限公司 | 代理人 | 赵继明 |
地址 | 201620 上海市松江区龙腾路333号 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及一种医疗机械臂的控制方法和装置,该方法包括以下步骤:A.初步定位,获取目标点位置和医疗机械臂末端位置,结合医疗机械臂各定位关节的当前定位夹角,计算各定位夹角的目标值,并驱动医疗机械臂各定位关节动作;B.精确调整,根据医疗机械臂末端和目标点的相对距离,进行微调定位;C.竖直矫正,控制医疗机械臂竖直向下运动至目标点位置。控制装置包括角度传感器、位置传感器、驱动电机和控制模块,控制模块的输入端与角度传感器和位置传感器连接,输出端与驱动电机的输入端连接,驱动电机的输出端与医疗机械臂连接。与现有技术相比,本发明具有定位精准等优点。 |
