CN106003051A - 一种基于fpga的七自由度力反馈主操作手控制系统 - Google Patents
一种基于fpga的七自由度力反馈主操作手控制系统 Download PDFInfo
- Publication number
- CN106003051A CN106003051A CN201610589812.3A CN201610589812A CN106003051A CN 106003051 A CN106003051 A CN 106003051A CN 201610589812 A CN201610589812 A CN 201610589812A CN 106003051 A CN106003051 A CN 106003051A
- Authority
- CN
- China
- Prior art keywords
- motor
- pulse
- fpga
- module
- control 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.)
- Withdrawn
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明公开了一种基于FPGA的七自由度力反馈主操作手控制系统,包括FPGA芯片、USB芯片、磁编码器脉冲输出电路、直流电机驱动电路。其中FPGA包括:磁编码器脉冲计数模块、正运动学计算模块、USB Slave FIFO读写模块、初始化及回零控制模块、直流电机控制模块。本发明利用FPGA可编程逻辑体系结构在芯片接口设计、编程及应用中的灵活性,以及在并行运行体系结构设计中的优势,大大减少集成芯片数量,降低硬件电路设计及调试难度,工程实现容易。
Description
技术领域
本发明涉及一种力反馈主操作手控制系统,并基于FPGA实现编码器脉冲计数、正运动学计算及直流电机驱动功能。
背景技术
力反馈主操作手是遥操作过程中的关键部件,是从端机械手进行实时运动控制的输入设备,又是反映从端机械手与环境之间相互作用力的一种力觉输出设备。作为人与机器人之间建立紧密动态耦合的重要接口,它可以向操作系统传送位姿、速度等多种信息;同时可以接受控制系统发来的力/力矩等环境信息,以便为操作者提供力觉临场感,实现对机器人的有效干预和控制。随着遥操作机器人在外科手术中应用的不断发展,力反馈主手发挥着越来越重要的作用。
目前商业化比较成功的Intuitive Surgical公司的达芬奇系统的主手为串联型结构,有8个运动自由度(7个自由度用来控制位置和姿态,1个自由度用来控制从手末端夹钳的开合角度)。该主手运动灵活,运动空间大,但是没有力反馈,医生无法感受器械接触到组织的物理特性,无法控制末端器械的力度。
哈尔滨工业大学基于国家“863”计划项目“微创腹腔外科手术机器人”设计的力反馈主手为串并联混合型7自由度结构,并实现了4自由度力反馈(三维空间力反馈和夹持力反馈),其控制系统采用传统的工控主机+多轴运动控制卡+伺服驱动器实现,系统不够紧凑并且很难保证控制系统实时力反馈效果。
瑞士Force Dimension公司利用Delta并联机构原理成功开发出三自由度和六自由度力反馈设备,其控制系统实现中将运动控制和伺服电机驱动集成到PCB板,使力反馈设备结构紧凑且有很好的实时力反馈效果,但控制系统使用大量IC芯片,使硬件电路结构复杂,调试困难且不便于产品后期扩展升级。
发明内容
本发明的目的是提供一种基于FPGA的七自由度力反馈主操作手控制系统。
本发明的目的是通过这样的技术方案实现的,一种基于FPGA的七自由度力反馈主操作手控制系统,包括FPGA芯片、USB芯片、磁编码器脉冲输出电路和直流电机驱动电路,所述,所述FPGA芯片包括:磁编码器脉冲计数模块、正运动学计算模块、USB Slave FIFO读写模块、初始化及回零控制模块和直流电机控制模块;
磁编码器脉冲输出电路根据电机正反转方向输出A、B两相相差±90°的脉冲信号;直流电机驱动电路根据输入的PWM控制信号输出大电流电机驱动信号,通过改变PWM控制信号占空比控制直流电机转速;
所述磁编码器脉冲计数模块对磁编码器脉冲输出电路输出的脉冲计数,并根据电机正反转加减脉冲计数器值;
所述正运动学计算模块根据脉冲计数器值、编码器单位脉冲对应的电机旋转弧度、主操作手机械结构尺寸以及正运动学公式计算出末端点空间位置坐标及姿态值;
所述USB Slave FIFO读写模块实现FPGA芯片与USB芯片之间数据的传输;
所述初始化及回零控制模块在控制系统接收到上位机发送的回零命令后,控制电机按一定方向旋转使主操作手回到机械零点并清零脉冲计数器的值;
所述直流电机控制模块输出上位机经过逆运动学计算后发送来的电机的PWM控制信号到直流电机驱动电路。
进一步,电机正转时,A相脉冲上升沿时B相脉冲为低电平;电机反转时,A相脉冲上升沿时B相脉冲为高电平。
进一步,所述磁编码器脉冲计数模块对磁编码器脉冲输入电路的A相脉冲上升沿计数,并根据电机正反转时B相电平高低加减脉冲计数器值。
由于采用上述技术方案,本发明具有如下的优点:
本发明所述的七自由度力反馈主操作手控制系统,采用与目前力反馈主操作手控制系统不一样的系统结构,提供一种基于FPGA的七自由度力反馈主操作手控制系统,利用FPGA可编程逻辑体系结构在芯片接口设计、编程及应用中的灵活性,以及在并行运行体系结构设计中的优势,大大减少集成芯片数量,降低硬件电路设计及调试难度,使控制系统结构紧凑,并能够满足力反馈实时性效果。
附图说明
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步的详细描述,其中:
图1为基于FPGA的七自由度力反馈主操作手控制系统的结构示意图;
图2为磁编码器输出脉冲信号示意图;
图3为直流电机PWM占空比控制信号示意图。
具体实施方式
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步的详细描述。
图1为本发明所述的基于FPGA的七自由度力反馈主操作手控制系统,包括FPGA芯片、USB芯片、磁编码器脉冲输出电路、直流电机驱动电路。其中FPGA芯片包括:磁编码器脉冲计数模块、正运动学计算模块、USB Slave FIFO读写模块、初始化及回零控制模块、直流电机控制模块。
磁编码器脉冲输出电路根据电机正反转方向输出A、B两相相差±90°的脉冲信号;直流电机驱动电路根据输入的PWM控制信号输出大电流电机驱动信号,通过改变PWM控制信号占空比控制直流电机转速;
所述磁编码器脉冲计数模块对磁编码器脉冲输出电路输出的脉冲计数,并根据电机正反转加减脉冲计数器值;
所述正运动学计算模块根据脉冲计数器值、编码器单位脉冲对应的电机旋转弧度、主操作手机械结构尺寸以及正运动学公式计算出末端点空间位置坐标及姿态值;
所述USB Slave FIFO读写模块实现FPGA芯片与USB芯片之间数据的传输;即从USB芯片端点2读取从上位机发送的数据,并往USB芯片端点6写入七路编码器计数器值和末端点空间位置及姿态值。
所述初始化及回零控制模块在控制系统接收到上位机发送的回零命令后,控制电机按一定方向旋转使主操作手回到机械零点并清零脉冲计数器的值;
所述直流电机控制模块输出上位机经过逆运动学计算后发送来的电机的PWM控制信号到直流电机驱动电路。
如图2所示给出了电机正反转时磁编码器输出的A、B两相脉冲信号,信号相位相差90°,所使用的磁编码器型号为Maxon MR编码器,旋转一周脉冲数为512个。正转时,A相脉冲上升沿时B相脉冲为低电平;反转时,A相脉冲上升沿时B相脉冲为高电平。由于本发明用于七自由度力反馈主操作手控制系统,因此磁编码器脉冲计数模块分别对此七路磁编码器脉冲输入电路的A相脉冲上升沿计数,并根据电机正反转时B相电平高低加减脉冲计数器值。
USB Slave FIFO读写模块能够实现FPGA芯片与USB芯片之间数据的传输,数据通讯频率为4KHz,并以时间片形式实现数据读写;上位机通过USB芯片发送7路电机PWM控制数据共16Byte到USB端点2FIFO,FPGA在读时间片检测到端点2非空标志后读取端点2FIFO中的数据并立即更新电机控制寄存器;上位机读取端点6FIFO数据后标志位会置空,FPGA在写时间片检测到端点6空标志后往端点6FIFO写入七路编码器计数器值以及末端点空间位置和姿态值共32Byte。
直流电机控制模块根据电机控制寄存器输出七个电机的PWM控制信号到直流电机驱动电路,直流电机驱动电路使用集成的电机驱动芯片L6202,根据输入的PWM控制信号能够输出最大1.5A的电流信号,能够驱动15W直流电机,通过改变PWM控制信号占空比来控制直流电机转速,如图3所示。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (3)
1.一种基于FPGA的七自由度力反馈主操作手控制系统,其特征在于:包括FPGA芯片、USB芯片、磁编码器脉冲输出电路和直流电机驱动电路,所述FPGA芯片包括:磁编码器脉冲计数模块、正运动学计算模块、USB Slave FIFO读写模块、初始化及回零控制模块和直流电机控制模块;
磁编码器脉冲输出电路根据电机正反转方向输出A、B两相相差±90°的脉冲信号;直流电机驱动电路根据输入的PWM控制信号输出大电流电机驱动信号,通过改变PWM控制信号占空比控制直流电机转速;
所述磁编码器脉冲计数模块对磁编码器脉冲输出电路输出的脉冲计数,并根据电机正反转加减脉冲计数器值;
所述正运动学计算模块根据脉冲计数器值、编码器单位脉冲对应的电机旋转弧度、主操作手机械结构尺寸以及正运动学公式计算出主操作手末端点空间位置坐标及姿态值;
所述USB Slave FIFO读写模块实现FPGA芯片与USB芯片之间数据的传输;
所述初始化及回零控制模块在控制系统接收到上位机发送的回零命令后,控制电机按一定方向旋转使主操作手回到机械零点并清零脉冲计数器的值;
所述直流电机控制模块输出上位机经过逆运动学计算后发送来的电机的PWM控制信号到直流电机驱动电路。
2.根据权利要求1所述的基于FPGA的七自由度力反馈主操作手控制系统,其特征在于:电机正转时,A相脉冲上升沿时B相脉冲为低电平;电机反转时,A相脉冲上升沿时B相脉冲为高电平。
3.根据权利要求2所述的基于FPGA的七自由度力反馈主操作手控制系统,其特征在于:所述磁编码器脉冲计数模块对磁编码器脉冲输入电路的A相脉冲上升沿计数,并根据电机正反转时B相电平高低加减脉冲计数器值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610589812.3A CN106003051A (zh) | 2016-07-25 | 2016-07-25 | 一种基于fpga的七自由度力反馈主操作手控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610589812.3A CN106003051A (zh) | 2016-07-25 | 2016-07-25 | 一种基于fpga的七自由度力反馈主操作手控制系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106003051A true CN106003051A (zh) | 2016-10-12 |
Family
ID=57116540
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610589812.3A Withdrawn CN106003051A (zh) | 2016-07-25 | 2016-07-25 | 一种基于fpga的七自由度力反馈主操作手控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106003051A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108582065A (zh) * | 2018-03-05 | 2018-09-28 | 杭州电子科技大学 | 基于fpga的六轴机械臂运动方程逆解快速求解的方法 |
CN108983691A (zh) * | 2017-06-05 | 2018-12-11 | 北京镁伽机器人科技有限公司 | 印刷电路板、机器人、运动控制部件、系统和方法 |
CN109780983A (zh) * | 2019-03-21 | 2019-05-21 | 安图实验仪器(郑州)有限公司 | 具有方向判断功能的步进电机实时位置检测系统及其方法 |
CN111113456A (zh) * | 2019-12-24 | 2020-05-08 | 兰州空间技术物理研究所 | 一种空间机械臂在轨操作平台及系统 |
-
2016
- 2016-07-25 CN CN201610589812.3A patent/CN106003051A/zh not_active Withdrawn
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108983691A (zh) * | 2017-06-05 | 2018-12-11 | 北京镁伽机器人科技有限公司 | 印刷电路板、机器人、运动控制部件、系统和方法 |
CN108983691B (zh) * | 2017-06-05 | 2020-02-28 | 北京镁伽机器人科技有限公司 | 印刷电路板、机器人、运动控制部件、系统和方法 |
CN108582065A (zh) * | 2018-03-05 | 2018-09-28 | 杭州电子科技大学 | 基于fpga的六轴机械臂运动方程逆解快速求解的方法 |
CN109780983A (zh) * | 2019-03-21 | 2019-05-21 | 安图实验仪器(郑州)有限公司 | 具有方向判断功能的步进电机实时位置检测系统及其方法 |
CN111113456A (zh) * | 2019-12-24 | 2020-05-08 | 兰州空间技术物理研究所 | 一种空间机械臂在轨操作平台及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106003051A (zh) | 一种基于fpga的七自由度力反馈主操作手控制系统 | |
CN105700465A (zh) | 基于EtherCAT总线的机器人柔顺控制系统和方法 | |
CN104589367B (zh) | 基于EtherCAT的模块化机器人驱动器和控制方法 | |
CN103558786B (zh) | 基于嵌入Android移动终端及FPGA的手部功能康复机器人人机交互控制系统 | |
CN104526696B (zh) | 一种新型四轴机器人控制系统 | |
CN203449306U (zh) | 一种主从式双工业机器人协调操作控制系统 | |
CN104647331A (zh) | 一种主从随动示教工业机器人系统 | |
CN104044049A (zh) | 一种具备力反馈控制的五轴联动抛光系统 | |
CN108663993B (zh) | 一种基于实时控制器的多轴伺服控制系统 | |
CN101598939A (zh) | 多轴运动伺服控制与保护系统 | |
CN204856122U (zh) | 冲压机器人控制系统 | |
CN204832853U (zh) | 一种多接口运动控制器 | |
CN101045298A (zh) | 一种多自由度机器人运动规划控制器 | |
CN110936381A (zh) | 一种机器人控制装置及机器人 | |
Huang et al. | Development of dual robotic arm system based on binocular vision | |
CN105892412A (zh) | 基于自定义总线的多轴运动控制系统硬件架构 | |
CN102830644B (zh) | 五轴高速点胶机器人伺服控制系统 | |
CN104353926B (zh) | 一种适用于复杂曲线器件自动化焊接的运动控制方法 | |
CN203588023U (zh) | 一种基于arm控制器的电动伺服机构 | |
Malinowski et al. | Control of articulated manipulator model using ATMEGA16 | |
CN202878317U (zh) | 一种多自由度工业机器人运动控制器 | |
Meshram et al. | Fpga based five axis robot arm controller | |
CN103543677B (zh) | 一种配药机器人的回零控制系统的实现方法 | |
CN206953010U (zh) | 一种遥操作手术机器人主操作手信号处理装置 | |
CN205566147U (zh) | 一种自控式步进电机控制器 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C04 | Withdrawal of patent application after publication (patent law 2001) | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20161012 |