技术干货

● 电容感应技术可以在任何环境因素下提供可靠的、强大的液位测量解决方案。

● 互电容传感器不易受寄生电容的影响。

● 测量结果的准确性取决于合适的校准、传感器的线性度以及是否能够消除影响性能的因素，比如传导性干扰和环境变化影响。

说到电容感应技术，我们首先想到的是不同设备的用户界面所使用的电容感应按钮。但这是电容感应技术的用途吗？非也。该项技术可用于任何系统输入可能引起电容变化的应用。电容传感器在许多应用中可以取代传统技术，如液体位置测量、湿度感应、金属物体检测等。它不会受环境条件变化的影响，同时更加可靠和稳定。

液体位置测量也是咖啡机等家用电器的一项重要功能。它能探测咖啡机中的水位或者奶瓶容器中牛奶的液位，也能探测洗衣机中洗衣液的用量。液位测量分为两种：

● 点液位测量：这种测量方式，传感器被安置在容器上的不同的区域，用于检测容器满或空的状态，并显示单个的较低分辨率的不连续的液位高度。

● 连续液位测量：正如其名所示，这种传感器可以精确探测到液位的细微变化。

每种传感器都有其各自的使用方式。本文主要介绍连续测量和确保测量精度的一些重要因素。

目前已有多种液位测量方法，包括：

● 磁性浮子：将磁体安装在一个随容器液位变化而移动的浮子上，并会促发杆体中密封的“舌簧开关”。这种解决方案具有很高的可重复性，但由于磁浮子的可移动性，因此寿命较短，可靠性也较低。

● 超声波传感：传感器传输到液体表面的超声波信号与反射的回波信号之间的延迟被转换为相关容器的液位。此类系统可以探测的液位取决于收发器的结构。测量会受到温度、压力和湿度等环境因素变化的影响。

● 导电测量：此类设备通过两个导电电极测量传导性。这种方法比前两种更可靠，但无法用于可燃液体。

显然，制造商需要更强大、更可靠、更精确且用途更广泛的液位测量技术。电容感应技术可以满足这些需求。它不使用任何运动部件，能够安全地用于易燃材料，且不会轻易受到环境变化的影响。

电容传感基础知识

电容感应技术是*可靠的液位监测方法。这是因为液体本身具有导电性，从而引起电容传感器的电容发生变化。

电容传感器分为两种：自电容和互电容。自电容使用单个引脚作为传感器，测量该引脚和地面之间的电容。这一电容被称为寄生电容。液体对传感器寄生电容的改变程度取决于液体体积。

互电容使用一对引脚。其中一个作为发送器(TX)，另一个作为接收器(RX)。这种方法测量的是两者之间的电容，即互电容。液体会引起互电容的变化，而变化程度取决于液位。互电容是的液位测量方法，其主要原因是它无需测量传感器的寄生电容。

互电容传感器的应用

让我们了解一下互电容液位测量如何应用于咖啡机。传感器可监测咖啡机液体容器中的水位。

图1：安装在咖啡机侧面(黄色长方形)的互电容传感器PCB用于测量储水容器中的液位

传感器PCB由互电容传感器组成，装在咖啡机的隔板中，而隔板与储水容器之间存在空隙(参见图2)。传感器的发送器和接收器位于其主板上，液体会改变它们之间的互电容。

中海德（福建）工业设备有限公司
畅销品牌
美国：FOXBORO：TRICONEX、系统、 IA系列板卡！美国：AB全系列PLC板卡！
美国：Honeywell：TDC、ESD、QCS、S9000、FCS、系列板卡！美国：DANAHER伺服！
德国：力士乐伺服电机系统板卡、GE Fanuc伺服及板卡等！德国： KUKA机器人备件！
德国：SIEMENS：S5、S7、TI等变频器、伺服驱动、PLC板卡！德国： SEW变频驱动
日立HITACHI伺服驱动器，YASKAWA安川伺服驱动! 三洋SANYO DENKI伺服控制器 发那科！
瑞典：ABB：460、S500S800、MOD、DSQC机器人全系备件！法国：Schneider、莫迪康！

＆联系人 ： 陈小真

＆ 洽谈电话 ： 0591-/ 18005006971

＆ 商务 QQ ： 

＆ 传真（FAX)： 0591-83489960
＆ 公司地址 ： 福建省福州市区乌龙江大道正荣财富中心B座八层

伺服电机及伺服驱动系统远程控制，问题再多也有套路！

本文针对伺服电机远程控制接线复杂性、单一性、不稳定性等问题，提出采用开放式通信协议DS301、驱动子协议DSP402实现伺服电机控制的新方法。

        前  言

CANopen是一种架构在控制局域网路（CAN）上的高层通讯协定，包括通讯子协定及设备子协定常在嵌入式系统中使用，也是工业控制常用到的一种现场总线。CANopen实现了OSI模型中的网络层以上（包括网络层）的协定。CANopen标准包括寻址方案、数个小的通讯子协定及由设备子协定所定义的应用层。CANopen支援网络管理、设备监控及节点间的通讯，其中包括一个简易的传输层，可处理资料的分段传送及其组合。一般而言数据链结层及物理层会用CAN来实作。除了CANopen外，也有其他的通讯协定（如EtherCAT）实作CANopen的设备子协定。

CANopen由非营利组织CiA进行标准的起草及审核工作，基本的CANopen设备及通讯子协定定义在CiA301中。针对个别设备的子协定以CiA301为基础再进行扩充。如针对I/O模组的CiA401及针对运动控制的CiA402。

针对伺服电机远程控制接线复杂、控制单一、可靠性不高等问题，提出利用CANopen通信协议、驱动子协议实现伺服电机控制的新方法。分析CANopen协议的对象字典和报文格式，详细介绍了CANopen伺服控制状态机各步骤的转换以及实现CANopen协议下PP、PV、HM3钟伺服控制模式的报文设置。利用CAN卡和伺服驱动设备以及伺服驱动设备以及PC机构建了实验平台，在上位机界面通过报文设置成功实现了基于CANopen协议的伺服电机的PP、PV、HM的三种模式的控制。实脸结果表明利用协议的报文设置控制电机简单易操作，通讯数据快速、可靠，用户通过上位机可以很好的实现对伺服电机的监控。

系统架构搭建

整个控制系统由PC机、CANopen上位机、USBCAN适配器、伺服驱动设备构成。CANopen通讯部分由DS301协议实现，伺服控制部分由DSP402协议实现伺服驱动设备作为的从节点，具有CANopen通讯功能，负责电机的电流、转速、位置等控制对象，它通过通信接口与总线相连，将信息传送给计算机的上位机界面；上位机界面则根据从站的反馈信息通过USBCAN适配器对伺服驱动设备实现控制。如图1所示为开放式通讯协议的伺服控制系统总体架构图。

图1 开放式通讯协议伺服控制系统总体架构图

开放式通讯协议伺服控制原理

1 CANopen通讯设备模型

CANopen的设备模型分为以下3个部分：通信单元、对象字典、应用过程。用户可以通过该模型对功能完全不同的设备进行描述。

CANopen的核心概念是对象字典，对象字典包含描述这个设备和它的网络行为的所有参数，应用单元和通信单元都可以问这个参数列表。对象字典中的参数通过一个16位索引和位子索引进行识别和定位。

通信部分由CAN收发器、CAN控制器和CANopen协议栈组成协议栈中定义了实现通讯的通讯对象：NMT（网络管理报文）、PDO（过程数据）SDO（服务数据对象）预定义报文或者特殊能对象（含同步报文、紧急报文、时间标记对象等）通信的所有内容和功能由这些通信对象描述，所有设备之间通信也通过这些通信对象完成。其中NMT用于主站对从站进行状态管理以及从站应答自身所处的通信状态，SDO用于主站对从站的对象字典进行配置和监控。PDO用来传输高速、小型数据。而特殊功能对象则用于同步网络中的通信对象（通常为PDO）的方法。应用部分是对设备的基本功能的定义和描述，它是连接设备与主站上位机的纽带，其核心功能是通过访问设备的对象字典对设备进行参数配置、状态控制和监控，并高速传输设备的过程数据信息。

2 伺服控制模式

CANopen驱动及运动控制设备子协议DSP402对特性的描述要求非常准确，它不仅定义了驱动器的运行模式，还定义了用于控制驱动器的状态机。驱动器状态机通过对象字典中的控制字6040来控制，并通过状态字6041来读取驱动器的状态。控制状态机如图2所示。

图2 控制状态机图

状态机可以分成以下3个部分：PowerDisabled(主电关闭)、PowerEbabled(主电打开)和Fault。所有状态在发生报警后均进入“Fault”在上电后，驱动器完成初始化，然后再进入SWUTCH_ON_DISABLED状态，在该状态，可以进行CAN通讯，可以对驱动器进行配置。此主电仍然关闭，电机没有被励磁。经过StateTransition（状态传输）2,3,4后，进入OPERATIONENABle此时，主电已开启，驱动器根据配置的工作模式控制电机。StateTransition（状态传输）9完成关闭电路主电。一旦驱动器发生报警，驱动器的状态都进入FAULT。

PP模式（简表位置模式）是典型的定位模式，可通过单步设定与连续设定两种方式控制电机运行到目标位置。PV模式（简表速度模式）是速度控制模式，HM（回零模式）提供多种达到起始位置的方法。

系统软硬件设计

1系统硬件设计

本文设计采用USBCAN和伺服驱动设备和PC机来搭建硬件平台。伺服驱动控制芯片采用的是DSP的芯片。

系统硬件搭建按以下步骤进行。首先在TI的开发环境中配置好的相关参数，并建立DS301工程项目，完成CANopen协议通信程序的调试运行。项目调试成功之后下载到驱动器中，在上位机界面中设置报文，测试SDO、PDO、NMT等通讯对象。测试结果正确则系统硬件搭建完成。

2系统软件设计

整个伺服控制的软件设计在CCS中建立，主要包括永磁同步电机的闭环控制程序和CANopen协议找的实现两大部分。如图3所示为软件设计流程图。

初始化部分程序主要完成DSP系统的初始化以及CANopen通讯的初始化。

初始化主要完成的工作如下：

初始化相关变量，使能全局中断，进人伺服电机编码器霍尔传感器反馈UVW三路信号来判断电机初始电角度位置。

初始化通讯的主要完成的工作如下：

设置从站节点地址和CAN通信波特率，初始化各通对象，完成各路的预定义映射，*后进入通信处理程序。

3伺服控制报文设置

CANopen报文结构由11位的COB-ID以及*多8字节的数据域构成。在上位机界面中通过NMT报文设置控制从站进入预作状态或者运行状态，再通过SDO报文设置伺服控制的各个参数（速度、位置等）以及状态机的各个状态可以使电机按照不同控制模式运转起来，*后通过将电机的当前参数映射到PDO中，读取PDO报文的值得到电机当前值，将其与设置值对比得到控制结果的正确性。控制报文全部由SDO实现。

以下为PP模式控制、PV模式控制和HM模式控制报文列表：

1.PP模式控制报文列表

2.PV模式控制报文列表

3.HM模式报文列表

以上三种控制模式报文操作都是首先设置伺服控制模式，然后根据当前模式依次输入相关的目标控制值（如位置、速度、回零方式等），*后按照状态机步骤使用6040h控制电机启动与停止。

仿真实验

本系统的上位机界面由USBCAN的上位机界面及电机的监控界面两部分构成，其中USBCAN的上位机界面作为CANopen报文数据监控界面，电机的监控界面用VB2008开发。在上位机界面中通信波特率选用1Mbps伺服电机Node-ID设置为1，心跳周期为1s，TPDO发送周期为100ms，同时设置好电机电流环、位置环、速度环的参数，将设置的报文依次输入上位机界面的SDO控制，电机启动并运行到报文中的设定值，电机手动遥控器显示值与设定值一致，同时上位机界面中报文显示值也与设定值一致，成功实现了伺服控制的控制。

1PP模式

电机监控界面中位置控制曲线如下图4所示：

图4 电机位置控制曲线

在上位机界面中设置好报文值，电机启动。电机先加速运行，达到设定的目标速度值后开始匀速运行，直至达到设定的目标位置值就不再变化。上位机过程数据与电机监控曲线变化一致。如果需要改变电机的位置值，在上位机界面中依次输人新的控制报文，电机会根据设定值正转或者反转，继续运行到新的位置。

VICKERS XCG 03 3F30 REDUCING VALVE RANGE MIN. TO 2850 PSI 
VICKERS 617193 VALVE COIL 110 V, 240/55 VA
VICKERS CG06C50 RELIEF VALVE NEW REPLACEMENT CG 06 C 50 SUB
VICKERS POPPET CHECK VALVE 125634
VICKERS HYDRAULIC PUMP V201P7P1C11 OR V201S7S1C11 NEW REPLACEM
VICKERS 941193 OEM REPLACEMENT COIL KIT NEW CONDITION IN BOX
VICKERS PVE21
VICKERS 35V30A 1C22R LOW NOISE VANE PUMP
Vickers FCG02150050 Hydraulic Pressure Compensated Flow Control
Vickers CF-16-F-10 3" Relief Valve 3" 1500 To 3000 PSI Pre
VICKERS 882954 PVE12 PISTON PUMP ROTATING GROUP.

Vickers / Eaton 382087-1, V10 Series Hydraulic Pump
VICKERS 941064 HYDRAULIC FILTER ELEMENT KITS,NEW OLD STOCK
Vickers 35VTCS25A223BB22R Hydraulic Pump
VICKERS 02-102508CARTRIDGE C KIT – # 02-102514-9
VICKERS HYDRAULIC  VALVE F3-DG5S-8-2B-M-FPBWL-B5-30 NEW
Vickers Vane Pump S-14 584612 P4 Cartridge
Vickers Vane Pump S-14 584612 Cam Ring
VICKERS HYDRAULIC  VALVE DG4V-3S-2A-M-FPBWL-B5-60 NEW
Vickers 25VTB21A201D20282 Hydraulic Vane Pump
VICKERS HYDRAULIC PUMP V10 1P4P 1C20－－-
－－－－中海德优惠VICKERS PVB15 PISTON SET OF 9
VICKERS BOSCH HYDRAULIC  FLANGE VALVE CPF1V-12-F-H-20 NEW
Vickers / Eaton, 02-341949, PVQ40, Quiet Series Industrial P
Vickers Eaton 922594 Hydraulic 10 Vanes Mack Truck 208SL27
VICKERS EATON DOUBLE HYDRAULIC VANE PUMP 2520VQ21A11
VICKERS LARGE HYDRAULIC PUMP VALVE AE1235
Vickers F3-35vq double S/S Seal Kit
VICKERS  PRESSURE FLOW CONTROL VALVE DGMFN-5-X-A2H-B2H NEW
Vickers PVB10 FRSY-20-CM11 Hydraulic Pump
Vickers 002011 Cam Ring  V104A10 Etc 2011 Hydraulic
Vickers  VTM42 40 65 10 MA R1 14 0431169-R-IZ93/0 REBUILT
VICKERS HYDRAULIC CONTROL  VALVE DG4V-3-2A-M-FPBWL-B6-60 NEW
VICKERS PVB15 ROTATING GROUP 938273- NEW!
Vickers Compensator For Hydraulic Pump O2-125162
VICKERS TA15 ROTATING GROUP 923062 - NEW!
Vickers Vane Pump S-17 584614 P2 Cartridge
VICKERS HYDRAULIC  VALVE DG4V-3-2B-M-FPBWL-B6-60 NEW
Vickers Hydraulic Pump PFB5FUY20 REBUILT
Vickers Vane Pump V14 584612 P5 Cartridge
VICKERS 585473 C KIT
VICKERS HYDRAULIC CONTROL DIRECTIONAL VALVE DG4V-3-6C-M-Fw-H7-60
Vickers FVB5 LSY-20 C-11 Hydraulic Pump
VICKERS PARKER 3 PVB5-FRSY-20-C11 220/440 VAC DG4V VALVE
VICKERS 892991 SPOOL KIT
VICKERS HYDRAULIC VANE PUMP, 25V17A-1B22R, 02-137113-2
VICKERS PVB6LSWY21CM11

VICKERS 926367 SPOOL KIT－－－－－－-中海德优惠
VICKERS HYDRAULIC SHAFT 2-1/4"X1-1/4" X0300380-1386-006
VICKERS HYDRAULIC VALVE NC SERVO TECH KAFDG5V72C150N85XVMFPH113
Vickers Hydraulic Piston Pump F3-PVB15-PSY-31-CM-11 Refurbished
Vickers / Eaton 02-466220, PVE Series Hydraulic Piston Pump
Vickers Spool Kit 926651
VICKERS PVH57 PISTON KIT 926257 or 02-306362 - NEW!
Vickers Vane Pump F32520V14A1 1AA12 180 Refurbished
VICKERS PVB10 ROTATING GROUP 938276 - NEW!
VICKERS CARTRIDGE 02-102539 C KIT
VICKERS PVE21 ROTATING GROUP 923947 - NEW!
Vickers / Eaton V10NF IS5T S38C4H20R Power Steering Pump
VICKERS 02-102533 CARTRIDGE KIT - MAYBE
VICKERS JOHN S. BARNES 736050-R HYDRAULIC PUMP
Vickers 9900224-002 Piston Pump Compensator For Q Serie

VICKERS SPACER BLOCK UNIT HYDRAULIC VALVE D488872
Vickers Vane Pump S-14 584612 Cartridge
VICKERS 3/4" NPT OUTLET 2-BOLT FLANGE  PUMP, V20-1R6P-22D11R
VICKERS MPVB10/MPVB15 SEAL KIT 919192
Vickers Hydraulic Filter Element 573082 BS7
Vickers V10 1S2S 11A20  500PSI 4000 RPM No Shaft
Vickers Hydraulic Pump 42163-1－－－－－－-中海德优惠
Vickers Hydraulic Pump PVK431296R REBUILT
VICKERS 882954 PVE12 PISTON PUMP ROTATING GROUP.
Variable Delivery Pump AS66411L-S666
Vickers Hydraulic pump axial pistions
Vickers 02-178087 Hydraulic Servo  Valve 24VDC 02178087
VICKERS 582348 CARTRIDGE C KIT – # 02-102-556
Vickers / Eaton VTM42 Power Steering Pump
VICKERS  PVB10 LS41CC12S124 PVB10LS41CC12S124 02-346011 042401
Vickers 2520V12A811BC20282 Hydraulic Double Vane Pump
VICKERS HYDRAULIC VALVE # CVCS25-C3-W-350-20
VICKERS 4525VQ SEAL KIT HYDRAULIC PUMP HYDRAULIC MOTOR
VICKERS HYDRAULIC PISTON PUMP PVB5-RSY-40-CMC-12
VICKERS 02-102577-9 CARTRIDGE KIT
Vickers Eaton Hydraulic Pump 123AL00025A PVM057ER
Vickers PVB15-FRSY-30-CM-1 Hydraulic Pump
Vickers Hydraulic Modular Manifold System SWO 07703 - 1
Vickers / Eaton 02-341697, PVQ32 Series Inline Piston Pump
VICKERS 02-102577 CARTRIDGE KIT - MAYBE
Vickers Aircraft Hydraulic  AS66411-L-S666 SPECIAL
VICKERS DG4V-3-869866 12 DC 30W 4810-01-296-4824 NEW
VICKERS F3PVP15FLSY31CM11  7/8" SHAFT DIA 1-1/4"NPT IN/OUT
VICKERS 581680 V50 VANE PUMP CARTRIDGE KIT 15/16＇＇

VICKERS/EATON PVH57/74/98 "IC" COMPENSATOR - NEW!
VICKERS TA15 SEAL KIT 923214
Vickers DG4V-3-0C-U-G 12 VDC

Vickers INC 22226 Baby Piston Plunger
VICKERS 582348 CARTRIDGE C KIT –CARTRIDGE # 02-102-556
Vickers GPA2-16-EK1-30R Hydraulic Gear Pump 0286440