CN108508811B - 一种轴间无通讯的四轴机器人伺服控制电路 - Google Patents
一种轴间无通讯的四轴机器人伺服控制电路 Download PDFInfo
- Publication number
- CN108508811B CN108508811B CN201810438486.5A CN201810438486A CN108508811B CN 108508811 B CN108508811 B CN 108508811B CN 201810438486 A CN201810438486 A CN 201810438486A CN 108508811 B CN108508811 B CN 108508811B
- Authority
- CN
- China
- Prior art keywords
- pin
- chip
- resistor
- port
- capacitor
- 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.)
- Active
Links
- 230000006854 communication Effects 0.000 title claims abstract description 45
- 238000004891 communication Methods 0.000 title claims abstract description 43
- 230000003287 optical effect Effects 0.000 claims abstract description 15
- 230000008878 coupling Effects 0.000 claims abstract description 10
- 238000010168 coupling process Methods 0.000 claims abstract description 10
- 238000005859 coupling reaction Methods 0.000 claims abstract description 10
- 238000002955 isolation Methods 0.000 claims abstract description 9
- 230000001360 synchronised effect Effects 0.000 claims abstract description 6
- 239000003990 capacitor Substances 0.000 claims description 102
- 230000002457 bidirectional effect Effects 0.000 claims description 41
- 102100039339 Atrial natriuretic peptide receptor 1 Human genes 0.000 claims description 8
- 101000961044 Homo sapiens Atrial natriuretic peptide receptor 1 Proteins 0.000 claims description 8
- 230000003993 interaction Effects 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000000034 method Methods 0.000 claims description 4
- 230000001143 conditioned effect Effects 0.000 claims description 3
- 239000000872 buffer Substances 0.000 claims description 2
- 238000001514 detection method Methods 0.000 claims description 2
- 239000004973 liquid crystal related substance Substances 0.000 claims description 2
- 238000012544 monitoring process Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 3
- 230000003321 amplification Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000003199 nucleic acid amplification method Methods 0.000 description 2
- 102100038374 Pinin Human genes 0.000 description 1
- 101710173952 Pinin Proteins 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Amplifiers (AREA)
Abstract
本发明公开了一种轴间无通讯的四轴机器人伺服控制电路，包括驱动模块、扩展通讯模块、模拟量反馈模块、速度反馈模块、FPGA模块、主控芯片等；其中，驱动模块包括光耦隔离模块和功率驱动模块，驱动模块接收主控芯片发出的PWM信号，经光耦隔离模块后控制功率驱动模块，从而控制四轴机器人上的永磁同步电机的运行；扩展通讯模块用于实现系统内外的拓展通讯功能；模拟量反馈模块用于获取电流、电压反馈；速度反馈模块用于获取伺服电机的速度，FPGA模块用于处理外部IO和运动控制器的信号并和主控芯片通讯，主控芯片用于处理各种信号，实现对电机的多种方式控制；本发明采用一块主控芯片同时控制四轴驱动，不存在主控芯片间的通讯过程，提升了控制实时性。
Description
技术领域
本发明涉及一种机器人伺服控制电路，尤其涉及一种轴间无通讯的四轴机器人伺服控制电路。
背景技术
现有的四轴机器人伺服控制器采用两块或四块主控芯片控制四路驱动，主控芯片间通过通讯总线进行协调通讯，以完成对四轴机器人的控制。由于轴间通讯需要耗费时间且可能遭受通讯噪声干扰，使得整个伺服控制系统的稳定性与实时性受到挑战。另一方面，目前的伺服控制器传感器有限，常只能实现对无编码器、增量式编码器、绝对式编码器电机中特定一类的控制，且对于运动控制器信号的处理方式也比较单一。
发明内容
针对现有技术的不足，本发明提供一种轴间无通讯的四轴机器人伺服控制电路。
本发明所采用的技术方案如下：一种轴间无通讯的四轴机器人伺服控制电路，包括电源模块、四个驱动模块、扩展通讯模块、四个模拟量反馈模块、四个速度反馈模块、FPGA模块、主控芯片；
其中，电源模块给整个伺服控制电路提供工作电压；
驱动模块包括光耦隔离模块和功率驱动模块，驱动模块接收主控芯片发出的PWM信号，经光耦隔离模块后控制功率驱动模块，从而控制四轴机器人上的永磁同步电机的运行；
扩展通讯模块收发主控芯片的SCI和eCAN端口的信号，通过扩展接口连接外部设备，实现通讯的扩展；
模拟量反馈模块由4个相同的模拟量反馈单元构成，模拟量反馈模块采集驱动模块及主控芯片模块上的电压、电流信号，将信号调理后传递至主控芯片的ADC接收口，保证主控芯片获得实时准确的模拟量反馈值；
速度反馈模块提供对光电编码器、绝对式编码器和霍尔传感器的接口，将采集上述三类的速度反馈信号，分别接入主控芯片的eQEP、RS485和IO，实现对多种速度反馈信号的处理，使得驱动电路能够用于控制无编码器电机、增量式编码器电机和绝对式编码器三种电机；FPGA模块作为向外部提供输出IO信号的输出端口和外部输入IO控制信号的输入端口，还用于接收运动控制器传来的脉冲信号与方向信号，经过计算后将解码后的控制指令通过IO总线传给主控芯片，使主控芯片能够获得准确的指令。
本发明与背景技术相比，具有的有益效果是：采用一块主控芯片同时控制四轴驱动，不存在主控芯片间的通讯过程，提升了控制实时性。具有含QEP、霍尔、RS485在内的多种速度反馈接口，可适应与无编码器、增量式编码器、绝对式编码器的配合。具有FPGA、CAP两种脉冲方向信号捕获方式，能够适应不同频率范围的运动控制器指令。丰富的传感器资源和主控芯片资源能够实现对电机的开环、电流环、速度环、位置环精确控制。
附图说明
图1为本发明的系统框图；
图2为功率驱动模块示意图；
图3为速度反馈模块示意图。
具体实施方式
下面结合附图和实施实例对本发明作进一步的说明。
一个应用实例是利用本发明实现对四台绝对编码式伺服电机进行的速度闭环控制，从而控制四轴SCARA工业机器人运动。其中速度的给定由外接的运动控制器完成。
如图1所示，本发明包括电源模块、驱动模块(4路)、扩展通讯模块、模拟量反馈模块(4路)、速度反馈模块(4路)、人机交互模块、FPGA模块、主控芯片(TMS320F28377D)。
其中，主控芯片是电路的核心部分，本发明选用TMS320F28377D作为主控芯片，是由于此芯片拥有24路PWM，其资源能够支撑同时控制四路电机驱动，而传统的DSP(如TMS320F28035、TMS320F28069等)并不具备这一能力。因此，本发明的MCU选型必须为TMS320F28377D或拥有同等或更丰富PWM资源和接近计算能力的MCU。除前述各个模块与主控芯片的连接关系及功能外，主控芯片可由CAP捕获口直接接收运动控制器的脉冲与方向信号并进行频率计算，此外由扩展数据和地址总线增强芯片性能。
电源模块采用开关电源进行降压，将输入高压降至5V，选用TPS259230芯片进行过流保护，选用TPS75733将5V电压转到3.3V，供给驱动模块和各个芯片正常运行所需的交直流电压；
驱动模块包括光耦隔离模块和功率驱动模块，驱动模块接收主控芯片发出的PWM信号，经光耦隔离模块后控制功率驱动模块，从而控制四轴机器人上的永磁同步电机的运行；
扩展通讯模块收发主控芯片的SCI和eCAN端口的信号，通过扩展接口连接外部设备，实现通讯的扩展；
模拟量反馈模块由4个相同的模拟量反馈单元构成，模拟量反馈模块采集驱动模块及主控芯片模块上的电压、电流信号，将信号调理后传递至主控芯片的ADC接收口，保证主控芯片获得实时准确的模拟量反馈值；
速度反馈模块提供对光电编码器、绝对式编码器和霍尔传感器的接口，将采集上述三类的速度反馈信号，分别接入主控芯片的eQEP、RS485和IO，实现对多种速度反馈信号的处理，使得驱动电路能够用于控制无编码器电机、增量式编码器电机和绝对式编码器三种电机；
FPGA模块作为向外部提供输出IO信号的输出端口和外部输入IO控制信号的输入端口，还用于接收运动控制器传来的脉冲信号与方向信号，经过计算后将解码后的控制指令通过IO总线传给主控芯片，使主控芯片能够获得准确的指令，FPGA模块选用EP3C16Q240C8N。
还包括人机交互模块，所述人机交互模块包含仿真器、JTAG接口、串行通信接口、MSP430、人机接口，JTAG接口用于连接主控芯片接口与仿真器，仿真器进一步在PC机和JTAG接口中间传递信息，以完成程序的仿真和烧写；电脑也可直接通过串行通信接口对设备进行烧写及完成通讯；MSP430芯片和人机接口相连，在人机接口上连接键盘、鼠标和液晶，构成一个简易的上位机，用于实现用户与驱动系统间便携式的交互。
具体的，驱动模块如图2所示，驱动模块包括光耦隔离模块和功率驱动模块，包括IPM芯片、电感L1、二极管MD1-MD4、电阻NPR1、电阻MR1-MR15、极性电容MC1、非极性电容MC2-MC8、极性电容MC9-MC11、电阻R57-R69、非极性电容C37-C39、可变电阻Rp1、运放U6D、运放U6C、光耦U11、双二极管D3、运放U10A；电阻NPR1的一端和电感L1的一端分别与电源模块的DC-相连；电阻NPR1的另一端和电电阻MR2的一端相连后分别与IPM芯片的NU端口、NV端口和NW端口相连，电阻MR2的另一端与IPM芯片的CSC端口相连，电感L1的另一端和二极管D1的负极相连，二极管D1的正极、极性电容MC1的正极和非极性电容MC2的一端相连后接IPM芯片的VCC端口，IPM芯片的VCC端口接+15V电压；非极性电容MC2的另一端与IPM芯片的COM端口相连，极性电容MC1的负极接地；非极性电容MC3的一端与IPM芯片的CFOD端口相连，非极性电容MC3的另一端与IPM芯片的COM端口相连，非极性电容MC4的一端与IPM芯片的CSC端口相连，非极性电容MC4的另一端与IPM芯片的COM端口相连；
电阻MR7的一端与IPM芯片的PWM输入引脚IN(WH)相连，电阻MR7的另一端和电阻MR1的一端相连，电阻MR1的另一端和IPM芯片的PWM输入引脚IN(UL)相连，电阻MR10的一端与IPM芯片的VCC端口相连，电阻MR10的另一端与二极管MD2的负极相连，二极管MD2的正极、非极性电容MC6的一端和极性电容MC9的正极均与IPM芯片的VB(W)端口相连，非极性电容MC6的另一端、极性电容MC9的负极和电阻MR13的一端均与IPM芯片的VS(W)端口相连，电阻MR13的另一端与IPM芯片的W端口相连；
电阻MR8的一端与IPM芯片的PWM输入引脚IN(VH)相连，电阻MR8的另一端和电阻MR3的一端相连，电阻MR3的另一端和IPM芯片的PWM输入引脚IN(VL)相连，电阻MR11的一端与IPM芯片的VCC端口相连，电阻MR11的另一端与二极管MD3的负极相连，二极管MD3的正极、非极性电容MC7的一端和极性电容MC10的正极均与IPM芯片的VB(V)端口相连，非极性电容MC7的另一端、极性电容MC10的负极和电阻MR14的一端均与IPM芯片的VS(V)端口相连，电阻MR14的另一端与IPM芯片的V端口相连；
电阻MR9的一端与IPM芯片的PWM输入引脚IN(UH)相连，电阻MR9的另一端和电阻MR4的一端相连，电阻MR4的另一端和IPM芯片的PWM输入引脚IN(WL)相连，电阻MR12的一端与IPM芯片的VCC端口相连，电阻MR12的另一端与二极管MD4的负极相连，二极管MD4的正极、非极性电容MC8的一端和极性电容MC11的正极均与IPM芯片的VB(U)端口相连，非极性电容MC8的另一端、极性电容MC11的负极和电阻MR15的一端均与IPM芯片的VS(U)端口相连，电阻MR15的另一端与IPM芯片的U端口相连；
电阻MR5的一端与IPMFAULT端口相连，电阻MR5的另一端与电阻MR6的一端相连，电阻MR6的另一端与和电容MC5的一端均与+3.3V电压相连，电容MC5的另一端接地；电阻R57的一端与IPM芯片的P端口相连，电阻R57的另一端接电源模块的DC+端口；
电阻R60的一端接电阻NPR1和电电阻MR2的公共端(OC端口)，电阻R60的另一端和非极性电容C38的一端均与运放U6D的正极输入端口相连，非极性电容C38的另一端接地，电阻R65的一端与运放U6D的负极相连，另一端接地。电阻R69一端与运放U6D的输出口相连，另一端与电阻R68的一端相连，电阻R68另一端和运放U6D的负输入端口相连。可调电阻Rp1线圈的两端跨接于运放U6D输出口和负输入端口；电阻R62一端接运放U6D输出口，另一端接运放U6C负输入端口；电容C39一端接运放U6C负输入端口，另一端接地；电阻R67一端接运放U6D负输入端口，另一端接探测点I_ad；电阻R58一端接3.3V电源，另一端接光耦U11的输入端口正极；光耦U11输入端口负极接地，输出端口负极也接地；电阻R59一端接光耦U11输出端口正极，另一端接3.3V电源；电阻R64一端接光耦U11输出端口，另一端接过流监测点OCFAULT，组合二极管D3的3号引脚接运放U6D输出端口，2号角接3.3V电源，1号角接地。
电阻R63一端接3.3V电源，另一端、电容C37的一端和电阻R66的一端均接运放U10A正输入端口；电阻R66一端接运放U10A负输入端口，另一端接地；电容C37和电阻R66的另一端均接地；运放U10A输出口接到运放U10A的负输入端口后与电阻R61的一端相连，电阻R61的另一端作为负反馈端口，该反馈端口与运放U6C的输入正端口相连。
驱动模块核心为IPM智能功率模块，选用FSBB20CH60，FSBB20CH60的PWM输入引脚IN(UH)、PWM输入引脚IN(UL)、PWM输入引脚IN(VH)、PWM输入引脚IN(VL)、PWM输入引脚IN(WL)、PWM输入引脚IN(WH)与主控芯片PWM引脚相连接，功率模块的PWM输出引脚U、PWM输出引脚V、PWM输出引脚W分别根据输入PWM信号得到功率放大后的PWM信号，对电机进行控制。U10-A运放MCP604-I接入电源模块提供的3.3V电压，分压在运放输出引脚上得到电压SREF3作为过流保护参考值。过流保护部分由两个MCP604-I运放(U6C/U6D)、光耦(U11)及外围电路组成，I_ad引脚采集母线电流接入运放负输入端口，运放输出口与光耦原边相接，光耦负边输出OCFAULT信号，这一信号可由主控芯片的AD引脚接收并判别是否过流。功率驱动模块共有4路，即以上对图2描述所涉及的元件及连接共有完全相同的4组。
具体的，速度反馈模块如图3所示，包括电阻R148-R163、C84-C99、接插件J7‐J10、双向收发芯片U20、四路差动线路接收芯片U21、收发芯片U22、四路差动线路接收芯片U23、电阻R148一端接5V电源，另一端接电容C87的一端及接插件J8的引脚4及四路差动线路接收芯片U21的1A输入引脚；
电阻R149一端接5V电源，另一端接电容C88的一端及接插件J8的引脚14及四路差动线路接收芯片U21的1B输入引脚；
电阻R150一端接5V电源，另一端接电容C89的一端及接插件J8的引脚9及四路差动线路接收芯片U21的2A输入引脚；
电阻R151一端接5V电源，另一端接电容C90的一端及接插件J8的引脚13及四路差动线路接收芯片U21的2B输入引脚；
电阻R152一端接5V电源，另一端接电容C91的一端及接插件J8的引脚7及四路差动线路接收芯片U21的3A输入引脚；
电阻R153一端接5V电源，另一端接电容C92的一端及接插件J8的引脚5及四路差动线路接收芯片U21的3B输入引脚；
电阻R155一端接5V电源，另一端接电容C93的一端及接插件J8的引脚6及四路差动线路接收芯片U23的1A输入引脚；
电阻R156一端接5V电源，另一端接电容C94的一端及接插件J8的引脚8及四路差动线路接收芯片U23的1B输入引脚；
电阻R157一端接5V电源，另一端接电容C95的一端及接插件J8的引脚11及四路差动线路接收芯片U23的2A输入引脚；
电阻R158一端接5V电源，另一端接电容C96的一端及接插件J8的引脚15及四路差动线路接收芯片U23的2B输入引脚；
电阻R159一端接5V电源，另一端接电容C97的一端及接插件J8的引脚10及四路差动线路接收芯片U23的3A输入引脚；
电阻R160一端接5V电源，另一端接电容C98的一端及接插件J8的引脚12及四路差动线路接收芯片U23的3B输入引脚。
电容C87-电容C98的另一端均接地；
四路差动线路接收芯片U21的1A输入引脚经由电阻R145与1B输入引脚相连；四路差动线路接收芯片U21的2A输入引脚经由电阻R146与2B输入引脚相连；四路差动线路接收芯片U21的3A输入引脚经由电阻R147与3B输入引脚相连；四路差动线路接收芯片U21的4A输入引脚与4B输入引脚相连并接地；四路差动线路接收芯片U21的1Y输出引脚与双向收发芯片U20的A1输入引脚相连；四路差动线路接收芯片U21的2Y输出引脚与双向收发芯片U20的A2输入引脚相连；四路差动线路接收芯片U21的3Y输出引脚与双向收发芯片U20的A3输入引脚相连；四路差动线路接收芯片U21的电源引脚VCC、控制引脚G、控制引脚
和电容C86的一端均接5V电源；电容C86的另一端接四路差动线路接收芯片U21的接地端口。
四路差动线路接收芯片U23的1A输入引脚经由电阻R161与1B输入引脚相连；四路差动线路接收芯片U23的2A输入引脚经由电阻R162与2B输入引脚相连；四路差动线路接收芯片U23的3A输入引脚经由电阻R163与3B输入引脚相连；四路差动线路接收芯片U23的4A输入引脚与4B输入引脚相连并接地；四路差动线路接收芯片U23的1Y输出引脚与双向收发芯片U20的A4输入引脚相连；四路差动线路接收芯片U23的2Y输出引脚与双向收发芯片U20的A5输入引脚相连；四路差动线路接收芯片U23的3Y输出引脚与双向收发芯片U20的A6输入引脚相连；四路差动线路接收芯片U23的电源引脚VCC、控制引脚G、控制引脚
和电容C99的一端均接5V电源；电容C99的另一端接四路差动线路接收芯片U23的接地端口。
接插件J8引脚3接地，引脚2接5V电源。
双向收发芯片U20输入引脚A7、A8、接地引脚GND和控制引脚
均接地，双向收发芯片U20的方向输入引脚DIR接5V电源，VCC引脚接3.3V电源，3.3V电源与控制引脚
之间接电容C84，双向收发芯片U20的输出引脚B1与接插件J7引脚2相连，双向收发芯片U20的输出引脚B2与接插件J7引脚3相连，双向收发芯片U20的输出引脚B3与接插件J7引脚4相连，双向收发芯片U20的输出引脚B4与接插件J9引脚1相连，双向收发芯片U20的输出引脚B5与接插件J9引脚2相连，双向收发芯片U20的输出引脚B6与接插件J9引脚3相连。
接插件J7引脚1接5V电源，引脚5、6接地；接插件J9引脚4接地。
收发芯片U22的输入输出双向引脚R连接到主控芯片的SCIRXD引脚，输入输出双向引脚D连接到主控芯片SCITXD引脚，控制引脚
及控制引脚DE相连后与主控芯片的GPIO28口相连，电源引脚VCC与3.3V电源连接，电源引脚VCC与地间接电容C85进行缓冲，接地引脚GND接地；
接插件J10引脚5接地，引脚1接4V电源，引脚6与引脚4短接，引脚7与收发芯片U22输入输出双向引脚B相连，引脚3与收发芯片U22输入输出双向引脚A相连，引脚3与引脚7之间接电阻R154；
速度反馈模块如图3所示，接插件J8为用于接收电机的U、V、W相电压信号和增量式编码器的A、B、I信号，J8接收到的A+、A-、B+、B-、I+、I-输入AM26LS32A(四路差动线路接收芯片U21)芯片的差分信号输入引脚1A、1B、2A、2B、3A、3B，再经由转换信号输出端口1Y、2Y、3Y输出，得到EQEP的A、B、I信号，A、B、I信号分别输入74LVC245芯片(双向收发芯片U20)的输入端口A1，A2，A3，并经由输出端口B1、B2、B3输出，输出的信号接入接插件J7引脚2、3、4，用于与主控芯片的PWM引脚连接；J1接收到的U+、U-、V+、V-、W+、W-信号手输入AM26LS32A(四路差动线路接收芯片U23)芯片的差分信号输入引脚1A、1B、2A、2B、3A、3B，再经由转换信号输出端口1Y、2Y、3Y输出，得到HALL的U、V、W信号，U、V、W信号分别输入74LVC245芯片(双向收发芯片U20)的输入端口A4，A5，A6，并经由输出端口B4、B5、B6输出，输出的信号接入接插件J9引脚1、2、3，用于与主控芯片HALL接收引脚连接。收发芯片U22为SN65HVD08芯片，通信输入引脚R接收RS485的SCI信号，通信输出引脚D用于发送RS485的信号，主控芯片的GPIO28连接收发芯片U22的控制引脚RE和控制引脚DE，用于控制信号方向，SCI输出引脚A、B分别输出经驱动增强后的信号，输出信号与接插件J10相连，J10为外部绝对编码器RS485信号的接口。速度反馈模块模块共有4路，即以上对图3描述所涉及的元件及连接共有完全相同的4组。
下面结合运动控制实例进行说明。运动控制器给定脉冲信号和方向信号，这一信号由FPGA模块获得，FPGA模块解析出对应的速度给定值和速度给定方向，通过IO总线传给主控芯片。
主控芯片得到速度指令信号后，对电机进行速度闭环控制。速度闭环控制依赖于模拟量反馈模块所采集到的两相电流值和速度反馈模块采集的速度信息。在此实例中速度反馈是由接于永磁同步电机后的绝对式编码器获得的。主控芯片经计算后得到此刻应该给出的四路PWM输出值。
四路PWM信号经光耦驱动进入功率驱动模块当中，功率驱动模块将进行功率放大后控制四台永磁同步电机运动。在稳定的闭环控制下，四台电机的组合运动使得SCARA机器人能够按照功能需求运行。
通过以上即实现了基本的机器人伺服控制。需要指出的是，机器人的运动控制指令不仅仅可以通过上述方式由运动控制器给定FPGA脉冲方向信号，还可以通过人机交互模块、扩展通讯模块及FPGA模块这几个开放接口中的一个或几个共同完成，实现对机器人的运动过程进行功能性与安全性的控制。通过人机接口或PC机可传给主控芯片丰富的控制指令，扩展通讯模块则使得本系统可以与其他设备进行通讯，完成协同性的工作。FPGA模块接收运动控制器的输入外，也可以接收外部设备的IO信号控制伺服电机的运动与紧急停止。
Claims (5)
1.一种轴间无通讯的四轴机器人伺服控制电路，其特征在于，包括电源模块、四个驱动模块、扩展通讯模块、四个模拟量反馈模块、四个速度反馈模块、FPGA模块、主控芯片；
其中，电源模块给整个伺服控制电路提供工作电压；
驱动模块包括光耦隔离模块和功率驱动模块，驱动模块接收主控芯片发出的PWM信号，经光耦隔离模块后控制功率驱动模块，从而控制四轴机器人上的永磁同步电机的运行；
扩展通讯模块收发主控芯片的SCI和eCAN端口的信号，通过扩展接口连接外部设备，实现通讯的扩展；
模拟量反馈模块由4个相同的模拟量反馈单元构成，模拟量反馈模块采集驱动模块及主控芯片模块上的电压、电流信号，将信号调理后传递至主控芯片的ADC接收口，保证主控芯片获得实时准确的模拟量反馈值；
速度反馈模块提供对光电编码器、绝对式编码器和霍尔传感器的接口，将采集上述三类的速度反馈信号，分别接入主控芯片的eQEP、RS485和IO，实现对多种速度反馈信号的处理，使得驱动电路能够用于控制无编码器电机、增量式编码器电机和绝对式编码器三种电机；
FPGA模块作为向外部提供输出IO信号的输出端口和外部输入IO控制信号的输入端口，还用于接收运动控制器传来的脉冲信号与方向信号，经过计算后将解码后的控制指令通过IO总线传给主控芯片，使主控芯片能够获得准确的指令；
所述驱动模块包括IPM芯片、电感L1、二极管MD1-MD4、电阻NPR1、电阻MR1-MR15、极性电容MC1、非极性电容MC2-MC8、极性电容MC9-MC11、电阻R57-R69、非极性电容C37-C39、可变电阻Rp1、运放U6D、运放U6C、光耦U11、双二极管D3、运放U10A；电阻NPR1的一端和电感L1的一端分别与电源模块的DC-相连；电阻NPR1的另一端和电阻MR2的一端相连后分别与IPM芯片的NU端口、NV端口和NW端口相连，电阻MR2的另一端与IPM芯片的CSC端口相连，电感L1的另一端和二极管D1的负极相连，二极管D1的正极、极性电容MC1的正极和非极性电容MC2的一端相连后接IPM芯片的VCC端口，IPM芯片的VCC端口接+15V电压；非极性电容MC2的另一端与IPM芯片的COM端口相连，极性电容MC1的负极接地；非极性电容MC3的一端与IPM芯片的CFOD端口相连，非极性电容MC3的另一端与IPM芯片的COM端口相连，非极性电容MC4的一端与IPM芯片的CSC端口相连，非极性电容MC4的另一端与IPM芯片的COM端口相连；
电阻MR7的一端与IPM芯片的PWM输入引脚IN(WH)相连，电阻MR7的另一端和电阻MR1的一端相连，电阻MR1的另一端和IPM芯片的PWM输入引脚IN(UL)相连，电阻MR10的一端与IPM芯片的VCC端口相连，电阻MR10的另一端与二极管MD2的负极相连，二极管MD2的正极、非极性电容MC6的一端和极性电容MC9的正极均与IPM芯片的VB(W)端口相连，非极性电容MC6的另一端、极性电容MC9的负极和电阻MR13的一端均与IPM芯片的VS(W)端口相连，电阻MR13的另一端与IPM芯片的W端口相连；
电阻MR8的一端与IPM芯片的PWM输入引脚IN(VH)相连，电阻MR8的另一端和电阻MR3的一端相连，电阻MR3的另一端和IPM芯片的PWM输入引脚IN(VL)相连，电阻MR11的一端与IPM芯片的VCC端口相连，电阻MR11的另一端与二极管MD3的负极相连，二极管MD3的正极、非极性电容MC7的一端和极性电容MC10的正极均与IPM芯片的VB(V)端口相连，非极性电容MC7的另一端、极性电容MC10的负极和电阻MR14的一端均与IPM芯片的VS(V)端口相连，电阻MR14的另一端与IPM芯片的V端口相连；
电阻MR9的一端与IPM芯片的PWM输入引脚IN(UH)相连，电阻MR9的另一端和电阻MR4的一端相连，电阻MR4的另一端和IPM芯片的PWM输入引脚IN(WL)相连，电阻MR12的一端与IPM芯片的VCC端口相连，电阻MR12的另一端与二极管MD4的负极相连，二极管MD4的正极、非极性电容MC8的一端和极性电容MC11的正极均与IPM芯片的VB(U)端口相连，非极性电容MC8的另一端、极性电容MC11的负极和电阻MR15的一端均与IPM芯片的VS(U)端口相连，电阻MR15的另一端与IPM芯片的U端口相连；
电阻MR5的一端与IPMFAULT端口相连，电阻MR5的另一端与电阻MR6的一端相连，电阻MR6的另一端与和电容MC5的一端均与+3.3V电压相连，电容MC5的另一端接地；电阻R57的一端与IPM芯片的P端口相连，电阻R57的另一端接电源模块的DC+端口；
电阻R60的一端接电阻NPR1和电阻MR2的公共端，电阻R60的另一端和非极性电容C38的一端均与运放U6D的正极输入端口相连，非极性电容C38的另一端接地，电阻R65的一端与运放U6D的负极相连，另一端接地；电阻R69一端与运放U6D的输出口相连，另一端与电阻R68的一端相连，电阻R68另一端和运放U6D的负输入端口相连；可变电阻Rp1线圈的两端跨接于运放U6D输出口和负输入端口；电阻R62一端接运放U6D输出口，另一端接运放U6C负输入端口；电容C39一端接运放U6C负输入端口，另一端接地；电阻R67一端接运放U6D负输入端口，另一端接探测点I_ad；电阻R58一端接3.3V电源，另一端接光耦U11的输入端口正极；光耦U11输入端口负极接地，输出端口负极也接地；电阻R59一端接光耦U11输出端口正极，另一端接3.3V电源；电阻R64一端接光耦U11输出端口，另一端接过流监测点OCFAULT，双二极管D3的3号引脚接运放U6D输出端口，2号脚接3.3V电源，1号脚接地；电阻R63一端接3.3V电源，电阻R63另一端、电容C37的一端和电阻R66的一端均接运放U10A正输入端口；电阻R66另一端接运放U10A负输入端口，电容C37和电阻R66的另一端均接地；运放U10A输出口接到运放U10A的负输入端口后与电阻R61的一端相连，电阻R61的另一端作为负反馈端口，该反馈端口与运放U6C的输入正端口相连，所述IPM芯片采用FSBB20CH60芯片。
2.根据权利要求1所述的一种轴间无通讯的四轴机器人伺服控制电路，其特征在于，所述主控芯片选用TMS320F28377D作为主控芯片。
3.根据权利要求1所述的一种轴间无通讯的四轴机器人伺服控制电路，其特征在于，还包括人机交互模块，所述人机交互模块包含仿真器、JTAG接口、串行通信接口、MSP430、人机接口，JTAG接口用于连接主控芯片接口与仿真器，仿真器进一步在PC机和JTAG接口中间传递信息，以完成程序的仿真和烧写；电脑也可直接通过串行通信接口对设备进行烧写及完成通讯；MSP430芯片和人机接口相连，在人机接口上连接键盘、鼠标和液晶，构成一个简易的上位机，用于实现用户与驱动系统间便携式的交互。
4.根据权利要求2所述的一种轴间无通讯的四轴机器人伺服控制电路，其特征在于，所述FPGA模块选用EP3C16Q240C8N。
5.根据权利要求1所述的一种轴间无通讯的四轴机器人伺服控制电路，其特征在于，所述速度反馈模块包括电阻R148-R163、C84-C99、接插件J7-J10、双向收发芯片U20、四路差动线路接收芯片U21、收发芯片U22、四路差动线路接收芯片U23；
电阻R148一端接5V电源，另一端接电容C87的一端及接插件J8的引脚4及四路差动线路接收芯片U21的1A输入引脚；
电阻R149一端接5V电源，另一端接电容C88的一端及接插件J8的引脚14及四路差动线路接收芯片U21的1B输入引脚；
电阻R150一端接5V电源，另一端接电容C89的一端及接插件J8的引脚9及四路差动线路接收芯片U21的2A输入引脚；
电阻R151一端接5V电源，另一端接电容C90的一端及接插件J8的引脚13及四路差动线路接收芯片U21的2B输入引脚；
电阻R152一端接5V电源，另一端接电容C91的一端及接插件J8的引脚7及四路差动线路接收芯片U21的3A输入引脚；
电阻R153一端接5V电源，另一端接电容C92的一端及接插件J8的引脚5及四路差动线路接收芯片U21的3B输入引脚；
电阻R155一端接5V电源，另一端接电容C93的一端及接插件J8的引脚6及四路差动线路接收芯片U23的1A输入引脚；
电阻R156一端接5V电源，另一端接电容C94的一端及接插件J8的引脚8及四路差动线路接收芯片U23的1B输入引脚；
电阻R157一端接5V电源，另一端接电容C95的一端及接插件J8的引脚11及四路差动线路接收芯片U23的2A输入引脚；
电阻R158一端接5V电源，另一端接电容C96的一端及接插件J8的引脚15及四路差动线路接收芯片U23的2B输入引脚；
电阻R159一端接5V电源，另一端接电容C97的一端及接插件J8的引脚10及四路差动线路接收芯片U23的3A输入引脚；
电阻R160一端接5V电源，另一端接电容C98的一端及接插件J8的引脚12及四路差动线路接收芯片U23的3B输入引脚；
电容C87-电容C98的另一端均接地；
四路差动线路接收芯片U21的1A输入引脚经由电阻R145与1B输入引脚相连；四路差动线路接收芯片U21的2A输入引脚经由电阻R146与2B输入引脚相连；四路差动线路接收芯片U21的3A输入引脚经由电阻R147与3B输入引脚相连；四路差动线路接收芯片U21的4A输入引脚与4B输入引脚相连并接地；四路差动线路接收芯片U21的1Y输出引脚与双向收发芯片U20的A1输入引脚相连；四路差动线路接收芯片U21的2Y输出引脚与双向收发芯片U20的A2输入引脚相连；四路差动线路接收芯片U21的3Y输出引脚与双向收发芯片U20的A3输入引脚相连；四路差动线路接收芯片U21的电源引脚VCC、控制引脚G、控制引脚
和电容C86的一端均接5V电源；电容C86的另一端接四路差动线路接收芯片U21的接地端口；
四路差动线路接收芯片U23的1A输入引脚经由电阻R161与1B输入引脚相连；四路差动线路接收芯片U23的2A输入引脚经由电阻R162与2B输入引脚相连；四路差动线路接收芯片U23的3A输入引脚经由电阻R163与3B输入引脚相连；四路差动线路接收芯片U23的4A输入引脚与4B输入引脚相连并接地；四路差动线路接收芯片U23的1Y输出引脚与双向收发芯片U20的A4输入引脚相连；四路差动线路接收芯片U23的2Y输出引脚与双向收发芯片U20的A5输入引脚相连；四路差动线路接收芯片U23的3Y输出引脚与双向收发芯片U20的A6输入引脚相连；四路差动线路接收芯片U23的电源引脚VCC、控制引脚G、控制引脚
和电容C99的一端均接5V电源；电容C99的另一端接四路差动线路接收芯片U23的接地端口；
接插件J8引脚3接地，引脚2接5V电源；
双向收发芯片U20输入引脚A7、A8、接地引脚GND和控制引脚
均接地，双向收发芯片U20的方向输入引脚DIR接5V电源，VCC引脚接3.3V电源，3.3V电源与控制引脚
之间接电容C84，双向收发芯片U20的输出引脚B1与接插件J7引脚2相连，双向收发芯片U20的输出引脚B2与接插件J7引脚3相连，双向收发芯片U20的输出引脚B3与接插件J7引脚4相连，双向收发芯片U20的输出引脚B4与接插件J9引脚1相连，双向收发芯片U20的输出引脚B5与接插件J9引脚2相连，双向收发芯片U20的输出引脚B6与接插件J9引脚3相连；
接插件J7引脚1接5V电源，引脚5、6接地；接插件J9引脚4接地；
收发芯片U22的输入输出双向引脚R连接到主控芯片的SCIRXD引脚，输入输出双向引脚D连接到主控芯片SCITXD引脚，控制引脚
及控制引脚DE相连后与主控芯片的GPIO28口相连，电源引脚VCC与3.3V电源连接，电源引脚VCC与地间接电容C85进行缓冲，接地引脚GND接地；
接插件J10引脚5接地，引脚1接4V电源，引脚6与引脚4短接，引脚7与收发芯片U22输入输出双向引脚B相连，引脚3与收发芯片U22输入输出双向引脚A相连，引脚3与引脚7之间接电阻R154；
所述四路差动线路接收芯片U21采用AM26LS32A芯片，所述双向收发芯片U20采用74LVC245芯片，所述四路差动线路接收芯片U23采用AM26LS32A芯片，所述收发芯片U22采用SN65HVD08芯片。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810438486.5A CN108508811B (zh) | 2018-05-09 | 2018-05-09 | 一种轴间无通讯的四轴机器人伺服控制电路 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810438486.5A CN108508811B (zh) | 2018-05-09 | 2018-05-09 | 一种轴间无通讯的四轴机器人伺服控制电路 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN108508811A CN108508811A (zh) | 2018-09-07 |
| CN108508811B true CN108508811B (zh) | 2020-09-11 |
Family
ID=63400166
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810438486.5A Active CN108508811B (zh) | 2018-05-09 | 2018-05-09 | 一种轴间无通讯的四轴机器人伺服控制电路 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108508811B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109820456B (zh) * | 2019-04-01 | 2023-11-21 | 东莞芯速科技有限公司 | 一种具有故事音乐播放功能的清洁机器人系统及控制方法 |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2702530Y (zh) * | 2004-02-18 | 2005-05-25 | 北京和利时电机技术有限公司 | 采用单主控芯片控制多台伺服电机的控制装置 |
| CN101826830A (zh) * | 2010-03-29 | 2010-09-08 | 陕西蒲白三通有限公司 | 带式输送机四机驱动功率平衡系统及功率平衡方法 |
| CN103378772A (zh) * | 2012-04-19 | 2013-10-30 | 林桂 | 基于fpga和dsp的多路直流电机控制系统 |
| CN105005308A (zh) * | 2015-08-24 | 2015-10-28 | 铜陵学院 | 基于stm32f407六轮灭火机器人伺服控制器 |
| CN105320039A (zh) * | 2015-11-10 | 2016-02-10 | 中国电子科技集团公司第二十一研究所 | Scara伺服控制系统 |
| CN105680735A (zh) * | 2016-02-03 | 2016-06-15 | 中国科学院自动化研究所 | 基于arm处理器的四轴伺服电机运动控制卡及方法 |
| CN205319984U (zh) * | 2015-11-20 | 2016-06-15 | 北京和利时电机技术有限公司 | 一种驱动控制装置 |
| CN206585490U (zh) * | 2017-03-13 | 2017-10-24 | 杭州爱数凯科技有限公司 | 一种单fpga实现的多台电机的控制系统 |
| CN107769659A (zh) * | 2017-12-01 | 2018-03-06 | 西安航天精密机电研究所 | 高速电机用磁悬浮轴承一体化控制系统及控制方法 |
-
2018
- 2018-05-09 CN CN201810438486.5A patent/CN108508811B/zh active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2702530Y (zh) * | 2004-02-18 | 2005-05-25 | 北京和利时电机技术有限公司 | 采用单主控芯片控制多台伺服电机的控制装置 |
| CN101826830A (zh) * | 2010-03-29 | 2010-09-08 | 陕西蒲白三通有限公司 | 带式输送机四机驱动功率平衡系统及功率平衡方法 |
| CN103378772A (zh) * | 2012-04-19 | 2013-10-30 | 林桂 | 基于fpga和dsp的多路直流电机控制系统 |
| CN105005308A (zh) * | 2015-08-24 | 2015-10-28 | 铜陵学院 | 基于stm32f407六轮灭火机器人伺服控制器 |
| CN105320039A (zh) * | 2015-11-10 | 2016-02-10 | 中国电子科技集团公司第二十一研究所 | Scara伺服控制系统 |
| CN205319984U (zh) * | 2015-11-20 | 2016-06-15 | 北京和利时电机技术有限公司 | 一种驱动控制装置 |
| CN105680735A (zh) * | 2016-02-03 | 2016-06-15 | 中国科学院自动化研究所 | 基于arm处理器的四轴伺服电机运动控制卡及方法 |
| CN206585490U (zh) * | 2017-03-13 | 2017-10-24 | 杭州爱数凯科技有限公司 | 一种单fpga实现的多台电机的控制系统 |
| CN107769659A (zh) * | 2017-12-01 | 2018-03-06 | 西安航天精密机电研究所 | 高速电机用磁悬浮轴承一体化控制系统及控制方法 |
Non-Patent Citations (2)
| Title |
|---|
| 一种交流伺服系统控制硬件电路设计;管晓虎 等;《测控技术》;20150818(第8期);第71-74页 * |
| 超高速永磁同步电机驱动控制系统设计与开发;陈永亮;《中国优秀硕士学位论文全文数据库》;20170715(第7期);第C042-88页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN108508811A (zh) | 2018-09-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103085054B (zh) | 带电抢修机器人主从式液压力反馈机械臂控制系统及方法 | |
| CN103269187B (zh) | 一种双电机同步控制系统及其控制方法 | |
| CN103744376B (zh) | 一种伺服驱动器及使用该伺服驱动器的多轴控制系统 | |
| CN203077287U (zh) | 带电抢修机器人主从式液压力反馈机械臂控制系统 | |
| CN105242587A (zh) | 一种双驱动混合型直流低压智能伺服驱动器电路 | |
| CN108508811B (zh) | 一种轴间无通讯的四轴机器人伺服控制电路 | |
| CN204832853U (zh) | 一种多接口运动控制器 | |
| CN102445924B (zh) | 一种一体化数控系统及一体化数控机床 | |
| CN202075630U (zh) | 伺服控制系统 | |
| CN100535812C (zh) | 全数字数控系统的驱动及连接装置 | |
| US20020188381A1 (en) | Control system for robots | |
| CN113385807B (zh) | 一种以太网网关的激光振镜控制系统和方法 | |
| CN109491332B (zh) | 一种用于机电伺服的高速高精密多轴并行控制系统 | |
| CN102904788A (zh) | 现场总线适配器及使用现场总线适配器的方法 | |
| CN203326934U (zh) | 一种双电机同步控制系统 | |
| CN111376263A (zh) | 一种复合机器人人机协作系统及其交叉耦合力控制方法 | |
| CN103123468A (zh) | 三轴天线测试机器人伺服控制器 | |
| CN108663958B (zh) | 一种输电线巡检机器人的全自动耦合控制系统 | |
| CN109866227A (zh) | 模组化多关节控制器 | |
| CN105373080A (zh) | 一种基于软总线的协同数控系统 | |
| CN212543685U (zh) | 一种双电机同步控制装置 | |
| CN114594695A (zh) | 一种基于fpga和dsp的惯性器件仿真控制系统 | |
| CN205622559U (zh) | 基于EtherCAT的全闭环步进电机伺服控制系统 | |
| CN205674208U (zh) | 一种混合式机器人控制装置 | |
| Jokanović et al. | Towards an OpenCNC |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |