CN110788874A - Manipulator for controlling clamping force to measure distance between clamping points - Google Patents
Manipulator for controlling clamping force to measure distance between clamping points Download PDFInfo
- Publication number
- CN110788874A CN110788874A CN201911001461.XA CN201911001461A CN110788874A CN 110788874 A CN110788874 A CN 110788874A CN 201911001461 A CN201911001461 A CN 201911001461A CN 110788874 A CN110788874 A CN 110788874A
- Authority
- CN
- China
- Prior art keywords
- section
- arm
- clamping
- value
- standard
- 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.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/081—Touching devices, e.g. pressure-sensitive
- B25J13/082—Grasping-force detectors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/02—Gripping heads and other end effectors servo-actuated
- B25J15/0253—Gripping heads and other end effectors servo-actuated comprising parallel grippers
- B25J15/026—Gripping heads and other end effectors servo-actuated comprising parallel grippers actuated by gears
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- A Measuring Device Byusing Mechanical Method (AREA)
Abstract
本发明公开了一种控制夹持力测量夹持点间距的机械手,用于工业机器人。该装置由夹持臂、编码丝杆、机架、驱动器和数控器组成。夹持臂包括具有力和变形传感功能的可动臂和固定臂。编码丝杆由测微丝杆和三态编码器组成,三态编码器包括齿盘和悬臂梁传感器。夹持臂与编码丝杆组成力‑变形‑位移复合传感机构,安装在机架上。数控器通过驱动器和编码丝杆控制夹持臂夹持物体,复合传感机构与数控器交互传输测控信号,数控器控制夹持力,并给出夹持点间距。
The invention discloses a manipulator for controlling the clamping force and measuring the distance between clamping points, which is used for industrial robots. The device consists of clamping arm, coding screw, frame, driver and numerical control. The gripper arm includes a movable arm and a fixed arm with force and deformation sensing functions. The coding screw is composed of a micrometer screw and a tri-state encoder, and the tri-state encoder includes a toothed disc and a cantilever beam sensor. The clamping arm and the coded screw rod form a force-deformation-displacement composite sensing mechanism, which is installed on the frame. The CNC controls the clamping arm to clamp the object through the driver and the coded screw. The composite sensing mechanism interacts with the CNC to transmit measurement and control signals. The CNC controls the clamping force and gives the distance between the clamping points.
Description
技术领域technical field
本设计为控制夹持力测量夹持点间距的机械手,用于工业机器人。This design is a manipulator that controls the gripping force and measures the distance between gripping points and is used in industrial robots.
背景技术Background technique
机械手是多种机器人的前端作业机构,一般安装在机器人的机械臂上,其基本功能是取放,即抓取、转移、释放物体。在取放过程中,需要控制机械手对物体的夹持力。为包括工业领域中大量自动化生产、加工、检测设备在内的机器人配置机械手,除取放功能外,还需要根据不同的作业任务,增加其它一些功能,如测量、识别、装配、调整等。在机械行业中,长度类尺寸测量,是最常见的测量,然而到目前为止,尚缺乏具备尺寸测量能力的机械手。设计此类机械手,要解决的关键问题是:如何实现既能有效控制夹持力,又能方便、快捷地测得尺寸数据并达到足够的精度。The manipulator is the front-end working mechanism of various robots. It is generally installed on the robotic arm of the robot. Its basic function is to pick and place, that is, to grab, transfer, and release objects. During the pick-and-place process, it is necessary to control the gripping force of the manipulator on the object. To configure manipulators for robots including a large number of automated production, processing, and testing equipment in the industrial field, in addition to the pick-and-place function, other functions, such as measurement, identification, assembly, adjustment, etc., need to be added according to different tasks. In the machinery industry, length dimension measurement is the most common measurement, but so far, there is still a lack of manipulators capable of dimension measurement. When designing such a manipulator, the key problem to be solved is: how to control the clamping force effectively, and measure the dimensional data conveniently and quickly with sufficient accuracy.
发明内容SUMMARY OF THE INVENTION
本设计的目的,是为工业机器人提供一种控制夹持力测量夹持点间距的机械手,用于取放机械零件等物体,并控制夹持力,跟踪测量夹持点间距,由夹持点间距得到物体长度、厚度、直径等尺寸数据以及变形量等其它数据。该机械手由导轨座、滑动机架、传动轴、编码丝杆、驱动器、夹持臂以及数控器组成。The purpose of this design is to provide an industrial robot with a manipulator that controls the clamping force and measures the distance between the clamping points. It is used to pick and place objects such as mechanical parts, and to control the clamping force. Spacing obtains dimensional data such as object length, thickness, diameter, and other data such as deformation. The manipulator consists of a guide rail seat, a sliding frame, a transmission shaft, a coding screw, a driver, a clamping arm and a numerical controller.
导轨座的结构包括长方形厚板、平行阳导轨和联轴器。平行阳导轨位于厚板上方的前后两侧,用于与滑动机架配合。联轴器固定在厚板的下方,用于连接机器人的手臂。The structure of the guide seat includes a rectangular thick plate, a parallel male guide and a coupling. The parallel male rails are located on the front and rear sides above the thick plate, and are used to cooperate with the sliding frame. The coupling is fixed under the thick plate and is used to connect the arm of the robot.
滑动机架的结构包括一长方形底板、位于底板下方前后两侧边沿的平行阴导轨、位于底板左下方的带有螺纹通孔的突台、位于底板上方左侧的左轴承支板、位于底板上方靠近右侧边的右轴承支板以及在底板上表面两轴承支板之间的U形导向限位槽。左轴承支板上嵌装有左轴承,右轴承支板上嵌装有右轴承,二者处于共轴位置。突台上螺纹通孔的轴线、导向限位槽的轴线、两轴承的轴线,均位于平行阴导轨的纵向对称面内,且与平行阴导轨的轴线平行。滑动机架与导轨座通过阳导轨与阴导轨的配合安装在一起。The structure of the sliding frame includes a rectangular bottom plate, parallel female guide rails located at the front and rear edges of the bottom plate, a protrusion with a threaded through hole located at the bottom left of the bottom plate, a left bearing support plate located above the bottom plate and a left bearing support plate located above the bottom plate. The right bearing support plate near the right side and the U-shaped guide limit groove between the two bearing support plates on the upper surface of the bottom plate. A left bearing is embedded on the left bearing support plate, and a right bearing is embedded on the right bearing support plate, and the two are in a coaxial position. The axis of the threaded through hole on the protruding platform, the axis of the guiding and limiting groove, and the axes of the two bearings are all located in the longitudinal symmetry plane of the parallel female guide rail and are parallel to the axis of the parallel female guide rail. The sliding frame and the guide rail seat are installed together through the cooperation of the male guide rail and the female guide rail.
传动轴的结构包括螺纹杆和螺纹杆左侧的连接轴,螺纹杆通过与突台上螺纹通孔的配合安装在滑动机架上,连接轴外伸到突台的左侧。The structure of the transmission shaft includes a threaded rod and a connecting shaft on the left side of the threaded rod. The threaded rod is installed on the sliding frame through the cooperation with the threaded through hole on the protruding table, and the connecting shaft extends to the left side of the protruding table.
编码丝杆由测微丝杆和三态编码器组成。测微丝杆为一带螺纹台阶轴,其结构从左到右分为I-II、II-III、III-IV三段,I-II段和III-IV段为光轴,II-III段为螺纹轴,螺纹外径大于I-II段光轴和III-IV段光轴的直径。测微丝杆通过I-II段光轴与左轴承的配合和III-IV段光轴与右轴承的配合安装在滑动机架上,其II-III段螺纹轴位于左轴承支板和右轴承支板之间,I-II段光轴外伸到左轴承支板的左侧,III-IV段光轴外伸到右轴承支板的右侧。II-III段螺纹轴的左、右两个端面分别与左轴承的右端面和右轴承的左端面配合,这两个配合副使测微丝杆不能左右串动。三态编码器由传感器支架、齿盘、左上悬臂梁传感器、右上悬臂梁传感器、左下悬臂梁传感器和右下悬臂梁传感器组成。传感器支架一般为矩形框架,固定在滑动机架底板的右上方,并将齿盘围在中间,框架的四条边顺次在靠近一侧边角的位置加工有一个轴线平行于框架平面且垂直于所在边的矩形通孔和一个与矩形通孔垂直联通的螺纹孔。齿盘为周边分布有圆弧齿的等厚度圆盘,共轴固定在测微丝杆的III-IV段光轴上。圆弧齿的数量取4的整数倍,例如180,500。四个悬臂梁传感器的形状和尺寸相同,采用的弹性体为等截面弹性梁或变截面弹性梁,根部分别与传感器支架的四个矩形通孔配合,并利用紧定螺钉固定于传感器支架的上侧内壁、右侧内壁、左侧内壁和下侧内壁。四个弹性梁在靠近自由端处朝向齿盘一侧分别加工有左三角形突棱、上三角形突棱、右三角形突棱、下三角形突棱,在靠近根部处分别沿梁轴线方向贴有单轴电阻应变计[R5,R6]、[R7,R8]、[R9,R10]和[R11,R12]。四个弹性梁均有一定量的预变形,预变形产生的弹性压力使四个三角形突棱的棱顶分别与齿盘周边的圆弧齿保持接触,接触点的具体位置按以下条件确定:The coding screw consists of a micrometer screw and a three-state encoder. The micrometer screw is a threaded stepped shaft, and its structure is divided into three sections from left to right: I-II, II-III, and III-IV. Sections I-II and III-IV are optical axes, and sections II-III are threaded shafts. , the outer diameter of the thread is larger than the diameter of the optical axis of the I-II segment and the optical axis of the III-IV segment. The micrometer screw rod is installed on the sliding frame through the cooperation between the optical axis of the I-II section and the left bearing and the cooperation of the optical axis of the III-IV section and the right bearing, and the threaded shaft of the II-III section is located on the left bearing support plate and the right bearing. Between the support plates, the optical axis of the I-II segment extends to the left side of the left bearing support plate, and the optical axis of the III-IV segment extends to the right side of the right bearing support plate. The left and right end faces of the II-III threaded shaft are respectively matched with the right end face of the left bearing and the left end face of the right bearing. These two matching pairs prevent the micrometer screw from moving left and right. The three-state encoder consists of a sensor bracket, a toothed disc, an upper left cantilever beam sensor, an upper right cantilever beam sensor, a lower left cantilever beam sensor, and a lower right cantilever beam sensor. The sensor bracket is generally a rectangular frame, which is fixed on the upper right of the bottom plate of the sliding frame, and surrounds the toothed disk in the middle. A rectangular through hole on the side and a threaded hole in vertical communication with the rectangular through hole. The toothed disc is an equal-thickness disc with circular arc teeth distributed around it, and is coaxially fixed on the optical axis of the III-IV segment of the micrometer screw. The number of arc teeth is an integer multiple of 4, such as 180, 500. The shape and size of the four cantilever beam sensors are the same. The elastic body used is a constant-section elastic beam or a variable-section elastic beam. Side inner wall, right inner wall, left inner wall and lower inner wall. The four elastic beams are respectively machined with left triangular protruding edge, upper triangular protruding edge, right triangular protruding edge and lower triangular protruding edge near the free end towards the side of the toothed disc, and are respectively attached with a single shaft along the beam axis near the root. Resistance strain gauges [R 5 , R 6 ], [R 7 , R 8 ], [R 9 , R 10 ] and [R 11 , R 12 ]. Each of the four elastic beams has a certain amount of pre-deformation, and the elastic pressure generated by the pre-deformation keeps the tops of the four triangular ridges in contact with the circular arc teeth around the toothed disc respectively. The specific position of the contact point is determined according to the following conditions:
a.设齿盘的纵向对称线刚好通过正上方圆弧齿和正下方圆弧齿的中心,同时齿盘的水平对称线刚好通过最左端圆弧齿和最右端圆弧齿的中心。a. The longitudinal symmetry line of the toothed plate just passes through the center of the arc tooth just above and the arc tooth directly below, and the horizontal line of symmetry of the tooth plate just passes through the center of the leftmost arc tooth and the rightmost arc tooth.
b.此时,左三角形突棱位于齿盘的水平对称线上,与最左端圆弧齿的顶点接触。右三角形突棱位于齿盘水平对称线和最右端圆弧齿的上侧,正对准相邻两圆弧齿之间的谷底。上三角形突棱和下三角形突棱均位于齿盘纵向对称线的右侧,分别与正上方圆弧齿的右侧和正下方圆弧齿的右侧接触。左三角形突棱到齿盘纵向对称线的距离用hmax表示,右三角形突棱到齿盘纵向对称线的距离用hmin表示,上三角形突棱与正上方圆弧齿接触点到齿盘水平对称线的距离和下三角形突棱与正下方圆弧齿接触点到齿盘水平对称线的距离相等,二者均用hmid表示。hmid与hmin和hmax之间存在式(1)表示的关系:b. At this time, the left triangular protruding edge is located on the horizontal symmetry line of the toothed disc, and is in contact with the vertex of the leftmost circular arc tooth. The right triangular protruding edge is located on the horizontal symmetry line of the toothed disc and the upper side of the rightmost circular arc tooth, and is aligned with the valley bottom between two adjacent circular arc teeth. Both the upper triangular protruding rib and the lower triangular protruding rib are located on the right side of the longitudinal symmetry line of the toothed disc, respectively contacting the right side of the directly above circular arc tooth and the right side of the directly lower circular arc tooth. The distance from the left triangular ridge to the longitudinal symmetry line of the chainring is represented by h max , the distance from the right triangular ridge to the longitudinal symmetry line of the chainring is represented by h min , and the contact point between the upper triangular ridge and the arc tooth just above is at the level of the chainring The distance of the symmetry line is equal to the distance from the contact point of the lower triangular protruding edge and the arc tooth directly below to the horizontal symmetry line of the chainring, both of which are represented by h mid . There is a relationship between h mid and h min and h max expressed by formula (1):
hmin、hmid和hmax统称特征高度,其中hmin是最小特征高度,hmid是平均特征高度,hmax是最大特征高度。h min , h mid and h max are collectively referred to as feature heights, where h min is the minimum feature height, h mid is the average feature height, and h max is the maximum feature height.
驱动器包括第一驱动器和第二驱动器,二者均可采用带有联轴器的步进电机。第一驱动器安装在导轨座的左上方,并通过联轴器与传动轴的连接轴固定连接。第二驱动器安装在左轴承支板的左侧,并通过联轴器与测微丝杆的I-II段光轴固定连接。The driver includes a first driver and a second driver, both of which can use a stepper motor with a coupling. The first driver is installed on the upper left of the guide rail seat, and is fixedly connected with the connecting shaft of the transmission shaft through the coupling. The second driver is installed on the left side of the left bearing support plate, and is fixedly connected with the optical axis of the I-II section of the micrometer screw through the coupling.
夹持臂由可动臂和固定臂组成,二者均为带有夹持器的悬臂式弹性梁传感器,两传感器所用弹性梁的材质、形状和尺寸相同。可动臂的弹性梁与一轴套固定连接,形成一体结构,轴套的中部嵌装有传动螺母,底部嵌装有限位导杆。可动臂通过传动螺母与测微丝杆的配合和限位导杆与U形导向限位槽的配合,安装在滑动机架上。限位导杆与U形导向限位槽的配合使可动臂不能绕测微丝杆的轴线转动,测微丝杆转动时,带动可动臂沿测微丝杆的轴线方向移动。传动螺母与测微丝杆配合副须采取消间隙措施,以达到两项要求:一是理论上可以认为测微丝杆改变旋转方向时,能够带动传动螺母无滞后反向移动;二是传动螺母的轴线在x-y平面内的转动自由度为零。固定臂的弹性梁与右轴承支板固定连接,形成一体结构。可动臂与固定臂的方向竖直朝上,二者处于对称位置。可动臂的弹性梁在b-c段左、右两侧沿梁轴线方向贴有单轴电阻应变计R2和R1,固定臂的弹性梁在b-c段左、右两侧沿梁轴线方向贴有单轴电阻应变计R3和R4,电阻应变计R1、R2、R3、R4组成全桥测量电路。夹持臂的弹性梁有以下两种基本结构形式:The gripping arm consists of a movable arm and a fixed arm, both of which are cantilevered elastic beam sensors with grippers, and the elastic beams used in the two sensors are of the same material, shape and size. The elastic beam of the movable arm is fixedly connected with a shaft sleeve to form an integrated structure, a transmission nut is embedded in the middle of the shaft sleeve, and a limit guide rod is embedded at the bottom. The movable arm is installed on the sliding frame through the cooperation between the transmission nut and the micrometer screw rod and the cooperation between the limit guide rod and the U-shaped guide limit groove. The cooperation of the limit guide rod and the U-shaped guide limit groove prevents the movable arm from rotating around the axis of the micrometer screw. When the micrometer screw rotates, the movable arm is driven to move along the axis of the micrometer screw. The matching pair of the transmission nut and the micrometer screw must take anti-backlash measures to meet two requirements: one is that theoretically, when the micrometer screw changes the direction of rotation, it can drive the transmission nut to move in the opposite direction without lag; the other is the transmission nut. The rotational degrees of freedom of the axis in the xy plane are zero. The elastic beam of the fixed arm is fixedly connected with the right bearing support plate to form an integrated structure. The directions of the movable arm and the fixed arm are vertically upward, and the two are in symmetrical positions. The elastic beam of the movable arm is attached with uniaxial resistance strain gauges R 2 and R 1 on the left and right sides of the bc section along the beam axis direction, and the elastic beam of the fixed arm is attached along the beam axis direction on the left and right sides of the bc section. Uniaxial resistance strain gauges R 3 and R 4 , resistance strain gauges R 1 , R 2 , R 3 , and R 4 form a full-bridge measurement circuit. The elastic beam of the clamping arm has the following two basic structural forms:
a)鱼钩形折梁,其结构包括长臂a-c段、转折节a-d段和短臂d-e段,三段的横截面均为矩形,截面c处为折梁的固定端。a-d段的截面尺寸远大于a-c段和d-e段的截面尺寸,可以将该段视为折梁的刚性节点。长臂a-c段的结构由上到下分为a-b和b-c两段,a-b段的高度H大于b-c段的高度h1。短臂d-e段一般为等截面梁。a) Fishhook-shaped folded beam, its structure includes a long arm ac section, a turning section ad section and a short arm de section, the cross sections of the three sections are all rectangular, and the section c is the fixed end of the folded beam. The section size of section ad is much larger than that of section ac and section de, and this section can be regarded as a rigid node of polybeam. The structure of the ac segment of the long arm is divided into two segments ab and bc from top to bottom, and the height H of the ab segment is greater than the height h 1 of the bc segment. The de section of the short arm is generally a beam of equal section.
b)直梁,其结构由上到下分为a-b和b-c两段,a-b段的高度H大于b-c段的高度h,a-b段和b-c段的横截面均为矩形,截面c处为梁的固定端,截面a处为梁的自由端。b) Straight beam, its structure is divided into two sections a-b and b-c from top to bottom, the height H of the a-b section is greater than the height h of the b-c section, the cross-sections of the a-b and b-c sections are rectangular, and the beam is fixed at the section c. end, the section a is the free end of the beam.
夹持臂的夹持器有面接触、线接触以及点接触三种类型,根据使用要求选用。鱼钩形折梁的夹持器设置在短臂d-e段的截面e处,例如图1中可动臂上的左夹面和固定臂上的右夹面,二者构成一对面接触型夹持器。两夹面的间距用s表示。直梁的夹持器设置在自由端a的左、右两侧,例如图4(a)中的第一夹持顶针和第二夹持顶针,二者构成一对点接触型夹持器;第三夹持顶针和第四夹持顶针构成一对向外支撑的点接触型夹持器。鱼钩形折梁可以按夹持器零转角条件设计。该条件是指:当夹持力作用线与梁纵向对称面和横截面e的交线重合时,横截面e和夹持器在纵向对称面内的转角为零。例如,设折梁各段的宽度都相等,在图1中用b表示。b-c段与d-e段高度相等,即h1=h2=h。a-b段的高度H≥5h,因此该段可视为刚体。a-c段长度L为b-c段长度l1的5倍,即L=5l1。根据弯曲理论,在线弹性小变形条件下,可以得到关系式:The gripper of the gripping arm has three types of surface contact, line contact and point contact, which are selected according to the requirements of use. The gripper of the fishhook-shaped folding beam is arranged at the section e of the de section of the short arm, for example, the left gripping surface on the movable arm and the right gripping surface on the fixed arm in Fig. 1 constitute a pair of surface-contact gripping surfaces. device. The distance between the two clamping surfaces is represented by s. The clamps of the straight beam are arranged on the left and right sides of the free end a, such as the first clamping thimble and the second clamping thimble in Figure 4(a), which constitute a pair of point-contact clamps; The third clamping thimble and the fourth clamping thimble constitute a pair of point-contact type clamps that are supported outward. Fishhook polybeams can be designed according to the condition of zero rotation of the gripper. This condition means: when the action line of the clamping force coincides with the intersection of the longitudinal symmetry plane of the beam and the cross section e, the rotation angle of the cross section e and the clamp in the longitudinal symmetry plane is zero. For example, it is assumed that the width of each segment of the polybeam is equal, which is indicated by b in Figure 1. The heights of the bc segment and the de segment are equal, that is, h 1 =h 2 =h. The height H of segment ab is ≥ 5h, so this segment can be regarded as a rigid body. The length L of the ac segment is 5 times the length l 1 of the bc segment, that is, L=5l 1 . According to the bending theory, under the condition of small linear elastic deformation, the relation can be obtained:
式(2)中,l2是d-e段的长度。只要L、l1和l2满足式(2),夹持器就能够保持零转角。In formula (2), l 2 is the length of de segment. As long as L, l 1 and l 2 satisfy equation (2), the gripper can maintain zero rotation angle.
数控器为带有应变信号采集-调理电路、驱动器控制电路和测量软件的微计算机测控系统,一般与机器人的控制系统集成在一起。电阻应变计R1、R2、R3、R4组成的全桥测量电路与应变信号采集-调理电路连接。电阻应变计[R5,R6]、[R7,R8]、[R9,R10]、[R11,R12]分别以半桥方式接入应变信号采集-调理电路,数控器测得的这四个半桥测量电路的应变读数分别用表示。第一驱动器和第二驱动器分别接入驱动器控制电路。The numerical control device is a microcomputer measurement and control system with a strain signal acquisition-conditioning circuit, a driver control circuit and a measurement software, and is generally integrated with the robot control system. A full-bridge measurement circuit composed of resistance strain gauges R 1 , R 2 , R 3 and R 4 is connected with the strain signal acquisition-conditioning circuit. The resistance strain gauges [R 5 , R 6 ], [R 7 , R 8 ], [R 9 , R 10 ], [R 11 , R 12 ] are respectively connected to the strain signal acquisition-conditioning circuit in a half-bridge manner, and the numerical control The measured strain readings for these four half-bridge measurement circuits are given by express. The first driver and the second driver are respectively connected to the driver control circuit.
在本设计中,编码丝杆是一个功能相对独立的部件,用于跟踪测量可动臂的位移。In this design, the coded screw is a relatively independent component that is used to track and measure the displacement of the movable arm.
编码丝杆按以下方式工作:The coded lead screw works as follows:
1)三态编码器测量电路零位调整:用数控器控制第二驱动器转动,测微丝杆和齿盘随之转动,应变读数均发生连续周期性变化,变化周期用T表示,T也表示齿盘上相邻两个圆弧齿的齿顶间距。齿盘每转过一个齿,即一个周期T,应变读数分别完成一次循环。跟踪观察的变化,当达到最小值εrmin时,停止齿盘的转动,调节数控器上电阻应变计[R5,R6]所在电桥的平衡电路,使之达到平衡状态,即重复前述动作,依次在 取得最小值εrmin时,调节电阻应变计[R7,R8]、[R9,R10]和[R11,R12]所在电桥的平衡电路,使按以上方法完成四个半桥测量电路零位调整后,再转动齿盘,则应变读数均在最小值0和一个最大值εrmax之间循环变化,最小值0对应于左三角形突棱或上三角形突棱或右三角形突棱或下三角形突棱处在正对相邻两圆弧齿之间的谷底位置,即对应最于小特征高度hmin,最大值εrmax对应于四个三角形突棱之一处在与圆弧齿顶点接触的位置,即对应于最大特征高度hmax。以上调整三态编码器测量电路零位的方法,称为零位四步调整法。1) Zero position adjustment of the three-state encoder measurement circuit: use the numerical controller to control the rotation of the second drive, the micrometer screw and the toothed disc rotate accordingly, and the strain reading All have continuous periodic changes, the change period is represented by T, and T also represents the tooth tip spacing of two adjacent circular arc teeth on the toothed disc. Every time the toothed disc rotates one tooth, that is, one cycle T, the strain reading Complete one cycle separately. Follow up changes, when When the minimum value ε rmin is reached, stop the rotation of the toothed disc, and adjust the balance circuit of the bridge where the resistance strain gauges [R 5 , R 6 ] on the numerical control device are located to reach a balanced state, that is, Repeat the above actions, in turn When the minimum value ε rmin is obtained, adjust the balance circuit of the bridge where the resistance strain gauges [R 7 , R 8 ], [R 9 , R 10 ] and [R 11 , R 12 ] are located so that After completing the zero position adjustment of the four half-bridge measurement circuits according to the above method, and then rotating the toothed plate, the strain reading Both are cyclically changed between a minimum value of 0 and a maximum value of ε rmax . The minimum value of 0 corresponds to the left triangular protruding edge or the upper triangular protruding edge or the right triangular protruding edge or the lower triangular protruding edge facing the adjacent two circular arc teeth. The valley bottom position between , that is, corresponds to the minimum characteristic height h min , and the maximum value ε rmax corresponds to the position where one of the four triangular ridges is in contact with the apex of the arc tooth, that is, corresponds to the maximum characteristic height h max . The above method of adjusting the zero position of the three-state encoder measurement circuit is called the zero position four-step adjustment method.
2)确定应变读数与齿盘旋转状态的关系:完成三态编码器测量电路零位调整后,规定用数字1、0和1/2分别表示应变读数的最大值εrmax、最小值0和平均值0.5εrmax。数字1与最大特征高度hmax对应,定义为满值。数字0与最小特征高度hmin对应,定义为零值。数字1/2与平均特征高度hmid对应,定义为中值。满值、零值和中值共同定义为应变读数的三态编码值,简称三态值。齿盘旋转时,三态值0、1/2、1按周期T循环变化。三态值的循环变化,用于确定齿盘的旋转状态,即齿盘的旋转方向和旋转角度。三态值总共有四种不同的组合,如表1所示:2) Determine the relationship between the strain reading and the rotation state of the toothed disc: After completing the zero position adjustment of the three-state encoder measurement circuit, it is specified that the
表1应变读数的三态值组合Table 1 Strain readings Tri-state value combination of
表2齿盘顺时针转动过程中,三态值0、1/2、1在每一个周期T内的变化。Table 2 Changes of
表中“↑”表示三态值增大,“↓”表示三态值减小In the table, "↑" indicates that the tri-state value increases, and "↓" indicates that the tri-state value decreases
表3齿盘逆时针转动过程中,三态值0、1/2、1在每一个周期T内的变化。Table 3 Changes of
表中“↑”表示三态值增大,“↓”表示三态值减小In the table, "↑" indicates that the tri-state value increases, and "↓" indicates that the tri-state value decreases
从表1中任选一个三态值组合,做为确定齿盘旋转状态的起始点,为明确起见,选择三态值组合1,则齿盘沿顺时针方向每转过一个齿,三态值按表2所示完成一个周期T的循环。齿盘沿逆时针方向每转过一个齿,三态值按表3所示完成一个周期T的循环。在表2和表3中,周期T被划分成四个1/4子周期,在每一个1/4子周期内,四个应变读数 的三态值0、1/2、1分别发生不同的升降变化。编号①至⑧的八行数据,两两互异,均具有唯一性,其中每一行数据都唯一地表示齿盘的一个特定旋转状态。例如,编号③的一行数据表示且只表示齿盘沿顺时针方向转过一个周期T内的第三个1/4周期,即0.5T至0.75T。编号⑤的一行数据表示且只表示齿盘沿逆时针方向转过一个周期T内的第一个1/4周期,即0至0.25T。连续变化的应变读数与三态值配合,监测齿盘的旋转状态。Choose a tri-state value combination from Table 1 as the starting point to determine the rotation state of the chainring. For the sake of clarity, choose the
3)测定可动臂的位移量:用数控器控制控制测微丝杆转动,将可动臂调整到测微丝杆上的某一指定位置或任意位置,将该位置记作为可动臂的位移原点,将此时齿盘的位置记作齿盘零位。使齿盘从齿盘零位开始转动,可动臂随之从位移原点起发生位移。用S表示可动臂相对于位移原点的位移量,称为赖原点位移,用公式(3)计算S:3) Measure the displacement of the movable arm: use the numerical controller to control the rotation of the micrometer screw, adjust the movable arm to a specified position or any position on the micrometer screw, and record the position as the movable arm. Displace the origin, and record the position of the chainring at this time as the zero position of the chainring. The toothed plate starts to rotate from the zero position of the toothed plate, and the movable arm is displaced from the displacement origin. S is used to represent the displacement of the movable arm relative to the displacement origin, which is called the displacement of the origin, and S is calculated by formula (3):
式(3)中,t表示测微丝杆(3)的导程,Nc表示齿盘的齿数,nz,s表示齿盘自齿盘零位起顺时针累计转过的齿数,nz,n表示齿盘自齿盘零位起逆时针累计转过的齿数,nz,s和nz,n恒取正值。nz表示nz,s与nz,n之差,定义为有效转动齿数。nz,s、nz,n和nz也称为齿盘转动参数。nz和S是代数量。齿盘顺时针转动时,可动臂向右移动,nz和S的符号均为“-”。齿盘逆时针转动时,可动臂向左移动,nz和S的符号均为“+”。In formula (3), t represents the lead of the micrometer screw (3), N c represents the number of teeth of the toothed disc, nz , s represents the number of teeth that the toothed disc has rotated clockwise since the zero position of the toothed disc, n z ,n represents the number of teeth that the chainring has rotated counterclockwise since the zero position of the chainring, and n z,s and n z,n are always positive. n z represents the difference between n z,s and n z,n , which is defined as the effective number of rotating teeth. n z,s , n z,n and n z are also referred to as sprocket rotation parameters. n z and S are the number of generations. When the chainring rotates clockwise, the movable arm moves to the right, and the signs of n z and S are both "-". When the chainring rotates counterclockwise, the movable arm moves to the left, and the signs of n z and S are both "+".
本设计的机械手,其使用方法包括以下步骤:The method of using the manipulator of this design includes the following steps:
1)测量线路连接。将电阻应变计R1、R2、R3、R4组成的全桥测量电路与数控器连接,该电路既用于夹持力F的传感测量,又用于夹持点间距s的传感测量。用于测F时,数控器测得的应变读数用εrf表示;用于测s时,数控器测得的应变读数用εrd表示。1) Measure the line connection. The full-bridge measurement circuit composed of resistance strain gauges R 1 , R 2 , R 3 , and R 4 is connected to the numerical controller. sensory measurement. When it is used to measure F, the strain reading measured by the numerical control device is expressed by ε rf ; when used to measure s, the strain reading measured by the numerical control device is expressed by ε rd .
2)测力系统标定。一般采用标准负荷传感器或标准测力环做为力值标准器,用夹持臂上的夹持器夹持力值标准器,对测力系统进行标定。以图1所示的面接触型夹持器为例,标定时,用可动臂上左的左夹面和固定臂上的右夹面夹持标准负荷传感器或标准测力环,由数控器控制可动臂移动,对可动臂和固定臂施加一组标准力F1,F2,…,FN,(F1<F2<…,<FN,N为不小于2的正整数,取值范围根据需要确定,例如取2≤N≤10),同时由数控器记下与F1,F2,…,FN对应的应变读数然后以 为标定数,用力F与应变读数εrf的函数关系,即式(4)计算力F:2) Calibration of the force measuring system. Generally, a standard load cell or a standard force measuring ring is used as the force value standard device, and the force value standard device is clamped by the gripper on the clamping arm to calibrate the force measuring system. Taking the surface contact type gripper shown in Figure 1 as an example, when calibrating, use the left grip surface on the movable arm and the right grip surface on the fixed arm to clamp the standard load cell or the standard force measuring ring, and the numerical control Control the movement of the movable arm, and apply a set of standard forces F 1 , F 2 , ..., F N to the movable arm and the fixed arm, (F 1 <F 2 <..., < F N , N is a positive integer not less than 2 , the value range is determined according to the needs, such as 2≤N≤10), and the numerical controller records the strain readings corresponding to F 1 , F 2 , ..., F N at the same time then with is the calibration number, the functional relationship between the force F and the strain reading ε rf , that is, the formula (4) calculates the force F:
式(4)中,A1和B1是常数,分别按公式(5)和(6)计算:In formula (4), A 1 and B 1 are constants, which are calculated according to formulas (5) and (6) respectively:
式(5)和(6)中,N表示标准力的序数,Fi表示不同序数标准力的力值,表示与力Fi对应的应变读数,即标定数标定中,弹性梁在标准力FN作用下产生的最大应力不得超过所用材料的比例极限。In equations (5) and (6), N represents the ordinal number of the standard force, F i represents the force value of the standard force with different ordinal numbers, Represents the strain reading corresponding to the force F i , i.e. the calibration number During calibration, the maximum stress generated by the elastic beam under the standard force F N shall not exceed the proportional limit of the material used.
3)测长度系统标定。测长度(夹持点间距)系统的标定,须根据夹持器的类型选择合适的长度标准器,标准直径规和标准厚度规是最常用的长度标准器。标准直径规为一组不同直径的标准圆柱,用于线接触型夹持器和面接触型夹持器;标准厚度规为一组不同厚度的标准厚度块规,主要用于点接触型夹持器,亦可用于线接触型夹持器和面接触型夹持器。各标准圆柱或标准块规的厚度值依次用d0,d1,d2…,dn表示,d0<d1<d2,…,<dn,n表示标准圆柱或标准块规的数量,一般取2≤n≤10(例如取n=7)。d0,d1,d2,…,dn也用于表示对应的标准圆柱或标准块规。这里以图4中(a)所示的点接触型夹持器为例,来说明标定方法。采用标准厚度规做为标准器,标准块规的厚度值应满足条件:当夹持臂的弹性梁在截面e处的挠度λ=dn-d0时,梁的最大应力值不超过所用材料的比例极限。标定分四步进行:第一步,为应变读数εrd预设一个初始值 一般在5με~20με范围内取值,例如取第二步,取标准块规d0,用数控器控制可动臂移动,由第一夹持顶针和第二夹持顶针夹持d0,当数控器测得的应变读数时,可动臂停止移动,将可动臂的当前位置记作位移原点,将齿盘的当前位置记作齿盘零位;第三步,用标准块规d1,d2…,dn依次替换d0,重复完成第二部动作,记下相应的应变读数第四步,以为标定数,按长度s与应变读数εrd的函数关系,即式(7),计算s:3) Calibration of length measuring system. For the calibration of the length measuring (grip point spacing) system, the appropriate length standard must be selected according to the type of the holder. The standard diameter gauge and the standard thickness gauge are the most commonly used length standards. The standard diameter gauge is a set of standard cylinders with different diameters for line contact grippers and surface contact grippers; the standard thickness gauge is a set of standard thickness block gauges with different thicknesses, mainly used for point contact gripping It can also be used for line contact grippers and surface contact grippers. The thickness value of each standard cylinder or standard block gauge is represented by d 0 , d 1 , d 2 . The number is generally 2≤n≤10 (for example, n=7). d 0 , d 1 , d 2 , ..., dn are also used to denote the corresponding standard cylinder or standard block gauge. Here, the calibration method will be described by taking the point contact type gripper shown in FIG. 4( a ) as an example. Using the standard thickness gauge as the standard, the thickness value of the standard block gauge should meet the conditions: when the deflection of the elastic beam of the clamping arm at the section e is λ=d n -d 0 , the maximum stress value of the beam does not exceed the material used ratio limit. The calibration is performed in four steps: In the first step, an initial value is preset for the strain reading ε rd Generally, the value is in the range of 5με~20με, for example, take In the second step, take the standard block gauge d 0 , use the numerical controller to control the movement of the movable arm, and clamp d 0 by the first clamping thimble and the second clamping thimble, when the numerical controller measures the strain reading When the movable arm stops moving, the current position of the movable arm is recorded as the displacement origin, and the current position of the toothed plate is recorded as the zero position of the toothed plate; in the third step, use the standard block gauge d 1 , d 2 … Substitute d 0 in turn, repeat the second action, and record the corresponding strain reading The fourth step is to is the calibration number, according to the functional relationship between the length s and the strain reading ε rd , that is, formula (7), calculate s:
式(7)中,A2和B2是常数,分别用公式(8)和(9)计算:In formula (7), A 2 and B 2 are constants, which are calculated by formulas (8) and (9), respectively:
式(8)和(9)中,n表示标准厚度块规的个数,di表示不同厚度标准厚度块规的厚度值,表示与di对应的应变读数,即标定数 In formulas (8) and (9), n is the number of standard thickness gauges, d i is the thickness value of standard thickness gauges with different thicknesses, Indicates the strain reading corresponding to d i , that is, the calibration number
式(4)和式(9)都是用线性拟合方法推导得出的。Equations (4) and (9) are both derived by the linear fitting method.
4)夹持测量作业。以图1所示的面接触型夹持器为例,说明作业过程。为简单起见,设物体为刚体,且位置固定。作业程序可以分为五步:第一步,由数控器调整机械手的位置和两夹面的间距s,使s大于物体的长度m,物体进入两夹面之间;第二步,控制第一驱动器转动,使固定臂随滑动机架向左移动,右夹面与物体接触,当应变读数时,停止第一驱动器的转动;第三步,控制第二驱动器转动,使可动臂向右移动,右夹面与物体接触,当应变读数时,停止第二驱动器的转动;第四步,控制两驱动器同时转动,使可动臂和固定臂同步相向移动,当应变读数εrd取得范围的任何一值εrdx时,记下εrdx、对应于εrdx的应变读数εrf以及赖原点位移S;第五步,将εrf代入式(4),将εrdx和S代入公式(10):4) Clamping and measuring operations. The operation process will be described using the surface contact type gripper shown in Fig. 1 as an example. For simplicity, let the object be a rigid body with a fixed position. The operation procedure can be divided into five steps: the first step is to adjust the position of the manipulator and the distance s between the two clamping surfaces by the numerical controller, so that s is greater than the length m of the object, and the object enters between the two clamping surfaces; the second step is to control the first The drive rotates, so that the fixed arm moves to the left with the sliding frame, and the right clamping surface is in contact with the object. When the strain reading When , stop the rotation of the first driver; in the third step, control the rotation of the second driver, so that the movable arm moves to the right, and the right clamping surface is in contact with the object, when the strain reading When , stop the rotation of the second driver; in the fourth step, control the two drivers to rotate at the same time, so that the movable arm and the fixed arm move synchronously towards each other, when the strain reading εrd is obtained At any value of ε rdx in the range, write down ε rdx , the strain reading ε rf corresponding to ε rdx , and the displacement S of the origin; the fifth step, substitute ε rf into equation (4), and substitute ε rdx and S into the formula ( 10):
式(4)给出物体受到的夹持力F,式(10)给出物体的长度m。Equation (4) gives the clamping force F of the object, and Equation (10) gives the length m of the object.
以夹持点间距s测量为基础,可以测量弹簧、橡胶等变形物体的变形。以压缩弹簧为例,测量程序分为三步:第一步,设定一个应变读数做为测量起点;第二步,用数控器控制夹持器夹持弹簧,使应变读数记下和与之对应的赖原点位移S*;第三步,增大夹持力F,跟踪记录F、应变读数εrd和赖原点位移S,按式(11)计算弹簧的变形量ν:Based on the measurement of the clamping point distance s, the deformation of deformed objects such as springs and rubber can be measured. Taking a compression spring as an example, the measurement procedure is divided into three steps: The first step is to set a strain reading As the starting point of measurement; in the second step, use the CNC to control the gripper to clamp the spring to make the strain reading Write down and the corresponding origin displacement S * ; in the third step, increase the clamping force F, track and record F, the strain reading ε rd and the origin displacement S, and calculate the spring deformation ν according to formula (11):
利用测量软件,可以绘制力-变形关系曲线,即F-ν曲线。Using the measurement software, the force-deformation relationship curve, that is, the F-ν curve, can be drawn.
与现有的机械手相比,本设计具有以下特点:Compared with the existing manipulator, this design has the following characteristics:
1、用夹持臂与编码丝杆组合机构控制夹持力,测量夹持点间距。本设计的机械手,核心部分是由夹持臂和编码丝杆组成的力-变形-位移复合传感机构,这一机构与驱动器和数控器配合,实现对夹持力F和夹持点间距s的闭环控制和测量。测得的F值,直接表示物体受到的力。测得的s值,对于刚性物体或结构,直接表示其厚度、外径、内径、孔距、间距等长度类尺寸;对于弹簧等弹性元件以及橡胶、植物果实等易变形物体,可以用s计算出需要测取的变形量,并且由软件给出力与变形的关系曲线。1. Use the combination mechanism of the clamping arm and the coding screw to control the clamping force and measure the distance between the clamping points. The core part of the manipulator of this design is a force-deformation-displacement composite sensing mechanism composed of a clamping arm and a coded screw rod. closed-loop control and measurement. The measured F value directly represents the force on the object. The measured s value, for a rigid object or structure, directly represents the thickness, outer diameter, inner diameter, hole distance, spacing and other length dimensions; for elastic elements such as springs and easily deformable objects such as rubber and plant fruits, s can be used to calculate The amount of deformation that needs to be measured is obtained, and the relationship between force and deformation is given by the software.
2、夹持具有柔性性质。本设计用夹持臂的弹性力夹持物体,并且由数控器控制夹持力变化,因此其夹持方式是柔性的。2. The clamping is flexible. The design uses the elastic force of the clamping arm to clamp the object, and the change of the clamping force is controlled by the numerical controller, so the clamping method is flexible.
3、测量具有柔性性质。本设计的机械手夹持刚性物体时,如果控制齿盘作小角度转动,使应变读数εrd连续变化,则可以看到,虽然εrd和赖原点位移S都在变化,但式(10)给出的长度值m却保持不变。这个现象称为“柔性等差输出”,是夹持臂和编码丝杆组成的力-变形-位移复合传感机构特有的性质,也是本设计测量夹持点间距的原理性依据。在一定范围内改变εrd,测得的长度m保持不变,而不同的εrd值对应着不同的夹持力。因此,测量软件的算法设计可以根据不同的作业对象和测量要求,对柔性等差输出性质加以利用。3. The measurement is flexible. When the designed manipulator clamps a rigid object, if the toothed plate is controlled to rotate at a small angle, so that the strain reading ε rd changes continuously, it can be seen that although ε rd and the displacement S of the origin point are both changing, formula (10) gives The resulting length value m remains unchanged. This phenomenon is called "flexible equal difference output", which is a unique property of the force-deformation-displacement composite sensing mechanism composed of the clamping arm and the coding screw, and is also the principle basis for measuring the distance between the clamping points in this design. Changing ε rd within a certain range, the measured length m remains unchanged, and different values of ε rd correspond to different clamping forces. Therefore, the algorithm design of the measurement software can make use of the flexible equidistant output properties according to different operation objects and measurement requirements.
4、夹持力及其测控精度的设计范围较宽。本设计的机械手,其夹持力的取值范围及对夹持力的测量分辨力主要由夹持臂所用弹性梁的结构形式、尺寸和材料性质决定,设计灵活性很大,既可以设计力值范围为0~10N、分辨力小于0.1N的夹持臂,也可以设计力值范围为0~5000N、分辨力小于1N的夹持臂。4. The design range of the clamping force and its measurement and control accuracy is wide. For the manipulator designed in this design, the value range of the clamping force and the measurement resolution of the clamping force are mainly determined by the structural form, size and material properties of the elastic beam used in the clamping arm, and the design flexibility is very large. The value range is 0 to 10N, and the gripping arm with the resolution less than 0.1N can also be designed with the force value range of 0 to 5000N and the gripping arm with the resolution less than 1N.
5、夹持点间距调整的设计范围较宽。本设计的机械手,其夹持点间距的调整范围,主要取决于可动臂的移程,理论上最小间距为零。因此,为夹持臂-编码丝杆组合机构选择适当长度的测微丝杆,可以得到需要的夹持点间距调整范围,例如0~20毫米,0~100毫米,200~500毫米。5. The design range of clamping point spacing adjustment is wide. For the manipulator designed in this design, the adjustment range of the distance between the clamping points mainly depends on the movement of the movable arm, and the theoretical minimum distance is zero. Therefore, selecting the appropriate length of micrometer screw for the clamping arm-encoding screw combination mechanism can obtain the required adjustment range of the clamping point spacing, such as 0-20 mm, 0-100 mm, 200-500 mm.
6、夹持点间距测量的分辨力可以达到机械工业中长度测量的中等水平。本设计的机械手,其夹持点间距测量分辨力,由夹持臂与编码丝杆两方面因素决定。夹持臂的位移分辨力与编码丝杆的位移分辨力,设计范围基本相同,为0.1微米~10微米。6. The resolution of the distance measurement between the clamping points can reach the medium level of the length measurement in the machinery industry. For the manipulator designed in this design, the measurement resolution of the distance between the clamping points is determined by the two factors of the clamping arm and the coding screw. The displacement resolution of the clamping arm and the displacement resolution of the coding screw are basically the same in design range, ranging from 0.1 μm to 10 μm.
附图说明Description of drawings
图1是本设计装置构造简图的主视图;Fig. 1 is the front view of the structural sketch of this design device;
图2是装置构造简图的右视图;Fig. 2 is the right side view of the device structure diagram;
图3是双悬臂梁传感器全桥测量电路示意图;Figure 3 is a schematic diagram of a full-bridge measurement circuit of a dual cantilever beam sensor;
图4是三态编码器的测量电路,其中(a)电阻应变计[R5,R6]半桥图,(b)电阻应变计[R7,R8]半桥图,(c)电阻应变计[R9,R10]半桥图,(d)电阻应变计[R11,R12]半桥图;Fig. 4 is the measurement circuit of the three-state encoder, in which (a) half-bridge diagram of resistance strain gage [R 5 , R 6 ], (b) half-bridge diagram of resistance strain gage [R 7 , R 8 ], (c) resistance strain gage [R 7 , R 8 ] half-bridge diagram Half-bridge diagram of strain gage [R 9 , R 10 ], (d) half-bridge diagram of resistance strain gage [R 11 , R 12 ];
图5是三态编码器构造原理简图;Fig. 5 is a schematic diagram of the construction principle of a three-state encoder;
图6是直梁形式夹持臂的示意图;Fig. 6 is the schematic diagram of the clamping arm in the form of a straight beam;
图中:1.导轨座,2.联轴器,3.阳导轨,4.传动轴,5.突台,6.第一驱动器,7.第二驱动器,8.左轴承支板,9.测微丝杆,10.左轴承,11.U形导向限位槽,12.传动螺母,13.限位导杆,14.右轴承,15.右轴承支板,16.可动臂,17.固定臂,18.左夹面,19.右夹面,20.传感器支架,21.右上悬臂梁传感器,22.齿盘,23.圆弧齿,24.左下悬臂梁传感器,25.右下悬臂梁传感器,26.滑动机架,27.阴导轨,28.左上悬臂梁传感器,29.左三角形突棱,30.上三角形突棱,31.右三角形突棱,32.下三角形突棱,33.矩形通孔,34.螺纹孔,35.紧定螺钉,36.第一夹持顶针,37.第二夹持顶针,38.第三夹持顶针,39.第四夹持顶针,40.第一夹持刃块,41.第二夹持刃块,42.第三夹持刃块,43.第四夹持刃块,TE.三态编码器,W.物体。In the picture: 1. Guide rail seat, 2. Coupling, 3. Male guide rail, 4. Transmission shaft, 5. Protruding table, 6. First driver, 7. Second driver, 8. Left bearing support plate, 9. Micrometer screw, 10. Left bearing, 11. U-shaped guide limit groove, 12. Transmission nut, 13. Limit guide rod, 14. Right bearing, 15. Right bearing support plate, 16. Movable arm, 17 .Fixed arm, 18. Left clamp surface, 19. Right clamp surface, 20. Sensor bracket, 21. Upper right cantilever beam sensor, 22. Gear plate, 23. Arc tooth, 24. Left lower cantilever beam sensor, 25. Right lower Cantilever beam sensor, 26. Sliding frame, 27. Female guide rail, 28. Left upper cantilever beam sensor, 29. Left triangular ridge, 30. Upper triangular ridge, 31. Right triangular ridge, 32. Lower triangular ridge, 33. Rectangular through hole, 34. Threaded hole, 35. Set screw, 36. First clamping thimble, 37. Second clamping thimble, 38. Third clamping thimble, 39. Fourth clamping thimble, 40 .1st clamping blade, 41. 2nd clamping blade, 42. 3rd clamping blade, 43. 4th clamping blade, TE. Tri-state encoder, W. Object.
具体实施方式Detailed ways
以下结合附图对本设计作进一步说明。The design will be further described below in conjunction with the accompanying drawings.
参照图1-图6,本设计为控制夹持力测量夹持点间距的机械手。该机械手由导轨座1、滑动机架26、传动轴4、编码丝杆、驱动器、夹持臂及数控器组成。Referring to Figures 1 to 6, this design is a manipulator that controls the clamping force and measures the distance between the clamping points. The manipulator consists of a
导轨座1的结构包括一长方形厚基板、联轴器2和平行阳导轨3。联轴器2固定在厚基板的下方,用于连接机器人的手臂。平行阳导轨3位于厚基板上表面的前后两侧。The structure of the
滑动机架26的结构包括一长方形底板、位于底板下方前后两侧边沿的平行阴导轨27、位于底板左下方的带有螺纹通孔的突台5、位于底板上方左侧的左轴承支板8、位于底板上方靠近右侧边的右轴承支板15、位于底板上表面的U形导向限位槽11。左轴承支板8上嵌装有左轴承10,右轴承支板15上嵌装有右轴承14。左轴承10与右轴承14处于共轴位置。突台5上螺纹通孔的轴线、导向限位槽11的轴线、左轴承10和右轴承14的轴线,均位于平行阴导轨27的纵向对称面内,并且与平行阴导轨27的轴线平行。滑动机架26与导轨座1通过阳导轨3与阴导轨27的配合安装在一起。The structure of the sliding
传动轴4的结构包括螺纹杆和螺纹杆左侧的连接轴,螺纹杆通过与突台5上螺纹通孔的配合安装在滑动机架26上,连接轴外伸到突台5的左侧。The structure of the
编码丝杆由测微丝杆9和三态编码器TE组成。The encoder screw consists of a
测微丝杆9为一带螺纹台阶轴,其结构从左到右分为I-II、II-III、III-IV三段,I-II段和III-IV段为光轴,II-III段为螺纹轴,螺纹外径大于I-II段光轴和III-IV段光轴的直径。测微丝杆9通过I-II段光轴与左轴承10的配合和III-IV段光轴与右轴承14的配合安装在滑动机架26上,其II-III段螺纹轴位于左轴承支板8和右轴承支板15之间,I-II段光轴外伸到左轴承支板8的左侧,III-IV段光轴外伸到右轴承支板15的右侧。II-III段螺纹轴的左、右两个端面分别与左轴承10的右端面和右轴承14的左端面配合,这两个配合副使测微丝杆9不能左右串动。The
三态编码器TE由传感器支架20、齿盘22、左上悬臂梁传感器28、右上悬臂梁传感器21、左下悬臂梁传感器24和右下悬臂梁传感器25组成。传感器支架20可以采用矩形框架,框架的四条边顺次在靠近一侧边角的位置加工有一个轴线平行于框架平面且垂直于所在边的矩形通孔33和一个与矩形通孔33垂直联通的螺纹孔34。齿盘22为周边均匀布满圆弧齿23的等厚度圆盘,圆弧齿23可以用镶嵌钢球的方式制成,也可以用切削工艺制成。圆弧齿23的数量取4的整数倍,例如180,500。四个悬臂梁传感器的形状和尺寸相同,采用的弹性体为等截面弹性梁或变截面弹性梁,四个弹性梁的根部分别与传感器支架20的四个矩形通孔33配合,并利用紧定螺钉35旋入螺纹孔34产生的压紧力,固定于传感器支架20的上侧内壁、右侧内壁、左侧内壁和下侧内壁。四个弹性梁在靠近根部处分别沿梁轴线方向贴有单轴电阻应变计[R5,R6]、[R9,R10]、[R11,R12]和[R7,R8]。四个弹性梁在靠近自由端处朝向齿盘22一侧分别加工有左三角形突棱29、上三角形突棱30、下三角形突棱32、右三角形突棱31。四个弹性梁均有一定量的预变形,预变形产生的弹性压力使四个三角形突棱的棱顶分别与圆弧齿23保持接触,接触点的具体位置按以下条件确定:The three-state encoder TE consists of a
a.设齿盘22的纵向对称线通过正上方圆弧齿和正下方圆弧齿的中心,同时齿盘22的水平对称线通过最左端圆弧齿和最右端圆弧齿的中心。a. Set the longitudinal symmetry line of the
b.此时,左三角形突棱29位于齿盘23的水平对称线上,与最左端圆弧齿的顶点接触。右三角形突棱31位于齿盘22水平对称线和最右端圆弧齿的上侧,正对相邻两圆弧齿23之间的谷底。上三角形突棱30和下三角形突棱32均位于齿盘23纵向对称线的右侧,分别与正上方圆弧齿的右侧和正下方圆弧齿的右侧接触。左三角形突棱29到齿盘22纵向对称线的距离用hmax表示,右三角形突棱31到齿盘23纵向对称线的距离用hmin表示,上三角形突棱30与正上方圆弧齿接触点到齿盘22水平对称线的距离和下三角形突棱32与正下方圆弧齿接触点到齿盘22水平对称线的距离相等,二者均用hmid表示。hmid与hmin和hmax之间存在式(1)表示的关系:b. At this time, the left
hmin、hmid和hmax统称特征高度,其中hmin是最小特征高度,hmid是平均特征高度,hmax是最大特征高度。h min , h mid and h max are collectively referred to as feature heights, where h min is the minimum feature height, h mid is the average feature height, and h max is the maximum feature height.
齿盘22共轴固定在测微丝杆9的III-IV段光轴上。传感器支架20固定在滑动机架26底板的右上方,并将齿盘22围在中间。The
驱动器包括第一驱动器6和第二驱动器7,二者均可采用步进电机。第一驱动器6安装在导轨座1的左上方,并与传动轴4的连接轴固定连接。第二驱动器7安装在左轴承支板8的左侧,并与测微丝杆9的I-II段光轴固定连接。The driver includes a first driver 6 and a second driver 7, both of which can use a stepping motor. The first driver 6 is installed on the upper left of the
夹持臂由可动臂16和固定臂17组成,二者均为带有夹持器的悬臂式弹性梁传感器,传感器的两副弹性梁的材质、形状和尺寸相同。可动臂16的弹性梁与一轴套固定连接,形成一体结构,轴套的中部嵌装有传动螺母12,底部嵌装有限位导杆13。可动臂16通过传动螺母12与测微丝杆9的配合和限位导杆13与U形导向限位槽11的配合,安装在滑动机架26上。限位导杆13与U形导向限位槽11的配合使可动臂16不能绕测微丝杆9的轴线转动,测微丝杆9转动时,带动可动臂16沿测微丝杆9的轴线方向移动。传动螺母12与测微丝杆9配合副须采取消间隙措施,以达到两项要求:一是理论上可以认为测微丝杆9改变旋转方向时,能够带动传动螺母12无滞后反向移动;二是传动螺母12的轴线在x-y平面内的转动自由度为零。固定臂17的弹性梁与右轴承支板15固定连接,形成一体结构。可动臂16的弹性梁与固定臂17的弹性梁竖直朝上,二者处于对称位置。夹持臂的弹性梁有两种基本结构形式:The clamping arm is composed of a
a)鱼钩形折梁,其结构包括长臂a-c段、转折节a-d段和短臂d-e段,三段的横截面均为矩形,截面c处为折梁的固定端;a-d段的截面尺寸远大于a-c段和d-e段的截面尺寸,因此该段可视为折梁的刚性节点。长臂a-c段的结构由上到下分为a-b和b-c两段,a-b段的高度H大于b-c段的高度h1。短臂d-e段为等截面梁。长臂a-c段、转折节a-d段和短臂d-e段的高度可以相等,也可以不相等。a) Fishhook-shaped folded beam, its structure includes a long arm ac section, a turning section ad section and a short arm de section, the cross-section of the three sections are all rectangles, and the section c is the fixed end of the folded beam; the section size of the ad section It is much larger than the section size of the ac and de sections, so this section can be regarded as a rigid node of the polybeam. The structure of the ac segment of the long arm is divided into two segments ab and bc from top to bottom, and the height H of the ab segment is greater than the height h 1 of the bc segment. The de section of the short arm is a beam of equal section. The heights of the long arm section ac, the turning section ad section and the short arm section de may be equal or unequal.
b)直梁,其结构由上到下分为a-b和b-c两段,a-b段的高度H大于b-c段的高度h,a-b段和b-c段的横截面均为矩形,截面c处为梁的固定端,截面a处为梁的自由端。b) Straight beam, its structure is divided into two sections a-b and b-c from top to bottom, the height H of the a-b section is greater than the height h of the b-c section, the cross-sections of the a-b and b-c sections are rectangular, and the beam is fixed at the section c. end, the section a is the free end of the beam.
可动臂16的弹性梁在b-c段左、右两侧沿梁轴线方向贴有单轴电阻应变计R2和R1,固定臂17的弹性梁在b-c段左、右两侧沿梁轴线方向贴有单轴电阻应变计R3和R4,电阻应变计R1、R2、R3、R4组成全桥测量电路。The elastic beam of the
夹持臂的夹持器有面接触、线接触以及点接触三种类型,根据使用要求选用。鱼钩形折梁的夹持器设置在短臂d-e段的截面e处,例如图1中可动臂16上的左夹面18和固定臂17上的右夹面19,二者构成一对面接触型夹持器。左夹面18与右夹面19的间距用s表示。直梁的夹持器设置在自由端a的左、右两侧,例如图6(a)中可动臂16上的第一夹持顶针36和固定臂17上的第二夹持顶针37,二者构成一对点接触型夹持器;可动臂16上的第三夹持顶针38和固定臂17上的第四夹持顶针39构成一对向外支撑的点接触型夹持器。当鱼钩形折梁夹持力的作用线与梁纵向对称面(图1中的x-y面)和横截面e的交线重合时,可以通过协调梁各部分的结构尺寸,使横截面e的转角等于零,从而使夹持器保持零转角。例如,设折梁各段的宽度b都相等,如图1所示;b-c段与d-e段高度相等,即h1=h2=h;a-b段的高度H≥5h,因此该段可以视为刚体。a-c段长度L为b-c段长度l1的5倍,即L=5l1。根据弯曲理论,在线弹性小变形条件下,可以得到关系式:The gripper of the gripping arm has three types of surface contact, line contact and point contact, which are selected according to the requirements of use. The gripper of the fishhook-shaped folding beam is arranged at the section e of the short arm de section, for example, the
式(2)中,l2是d-e段的长度。只要L、l1和l2满足式(2),横截面e的转角就等于零,图1中左夹面18和右夹面19就能够保持零转角。In formula (2), l 2 is the length of de segment. As long as L, l 1 and l 2 satisfy formula (2), the corner of the cross section e is equal to zero, and the left and right clip surfaces 18 and 19 in FIG. 1 can maintain zero corners.
数控器(未在图中画出)为带有应变信号采集-调理电路、驱动器控制电路和测量软件的微计算机系统,所述的测量软件按照如下方法思路编写即可。电阻应变计R1、R2、R3、R4组成的全桥测量电路与应变信号采集-调理电路连接。电阻应变计[R5,R6]、[R7,R8]、[R9,R10]、[R11,R12]分别以半桥方式接入应变信号采集-调理电路,数控器测得的这四个半桥测量电路的应变读数分别用表示。第一驱动器6和第二驱动器7分别接入驱动器控制电路。数控器一般与机器人的控制系统集成在一起,也可以单独设置。The numerical control device (not shown in the figure) is a microcomputer system with a strain signal acquisition-conditioning circuit, a driver control circuit and measurement software, and the measurement software can be written according to the following methods and ideas. A full-bridge measurement circuit composed of resistance strain gauges R 1 , R 2 , R 3 and R 4 is connected with the strain signal acquisition-conditioning circuit. The resistance strain gauges [R 5 , R 6 ], [R 7 , R 8 ], [R 9 , R 10 ], [R 11 , R 12 ] are respectively connected to the strain signal acquisition-conditioning circuit in a half-bridge manner, and the numerical control The measured strain readings for these four half-bridge measurement circuits are given by express. The first driver 6 and the second driver 7 are respectively connected to the driver control circuit. The numerical controller is generally integrated with the control system of the robot, and can also be set separately.
在本设计中,编码丝杆是一个具有独立功能的部件,可以跟踪测量可动臂16的位移。In this design, the coded screw is a component with independent functions that can track and measure the displacement of the
编码丝杆按以下方式工作:The coded lead screw works as follows:
1)三态编码器测量电路零位调整:用数控器控制第二驱动器7带动编码丝杆转动,应变读数均发生连续周期性变化,变化周期用T表示。齿盘22每转过一个齿,即一个周期T,分别完成一次循环。跟踪观察的变化,当达到最小值εrmin时,停止齿盘22的转动,调节数控器中电阻应变计[R5,R6]所在电桥的平衡电路,使重复前述动作,依次在取得最小值εrmin时,调节电阻应变计[R7,R8]、[R9,R10]和[R11,R12]所在电桥的平衡电路,使完成四个半桥电路零位调整后,再转动齿盘22,则均在最小值0和一个最大值εrmax之间循环变化,最小值0对应于左三角形突棱29或上三角形突棱30或右三角形突棱31或下三角形突棱32处在正对相邻两圆弧齿23之间的谷底位置,即对应最于小特征高度hmin,最大值εrmax对应于四个三角形突棱之一处在与圆弧齿23顶点接触的位置,即对应于最大特征高度hmax。调整三态编码器TE测量电路零位的方法,称为零位四步调整法。1) Zero position adjustment of the three-state encoder measurement circuit: use the numerical controller to control the second driver 7 to drive the encoder screw to rotate, and the strain reading There are continuous periodic changes, and the change period is represented by T. Each time the
2)确定应变读数与齿盘旋转状态的关系:完成三态编码器TE测量电路零位调整后,规定用数字1、0和1/2分别表示应变读数的最大值εrmax、最小值0和平均值0.5εrmax。数字1与最大特征高度hmax对应,定义为满值。数字0与最小特征高度hmin对应,定义为零值。数字1/2与平均特征高度hmid对应,定义为中值。满值、零值和中值共同定义为应变读数的三态编码值,简称三态值。齿盘22旋转时,三态值0、1/2、1按周期T循环变化。三态值的循环变化,用于确定齿盘22的旋转状态,即齿盘22的旋转方向和旋转角度。三态值总共有四种不同的组合,如表1所示:2) Determine the relationship between the strain reading and the rotation state of the toothed disc: After completing the zero position adjustment of the TE measurement circuit of the three-state encoder, it is specified that the
表1应变读数的三态值组合Table 1 Strain readings Tri-state value combination of
表2齿盘22顺时针转动过程中,三态值0、1/2、1在每一个周期T内的变化。Table 2 Changes of the
表中“↑”表示三态值增大,“↓”表示三态值减小In the table, "↑" indicates that the tri-state value increases, and "↓" indicates that the tri-state value decreases
表3齿盘22逆时针转动过程中,三态值0、1/2、1在每一个周期T内的变化。Table 3 Changes of the
表中“↑”表示三态值增大,“↓”表示三态值减小In the table, "↑" indicates that the tri-state value increases, and "↓" indicates that the tri-state value decreases
从表1中任选一个三态值组合,做为确定齿盘旋转状态的起始点,为明确起见,选择三态值组合1,则齿盘沿顺时针方向每转过一个齿,三态值按表2所示完成一个周期T的循环。齿盘沿逆时针方向每转过一个齿,三态值按表3所示完成一个周期T的循环。在表2和表3中,周期T被划分成四个1/4子周期,在每一个1/4子周期内,四个应变读数 的三态值0、1/2、1分别发生不同的升降变化。编号①至⑧的八行数据,两两互异,均具有唯一性,其中每一行数据都唯一地表示齿盘的一个特定旋转状态。例如,编号③的一行数据表示且只表示齿盘沿顺时针方向转过一个周期T内的第三个1/4周期,即0.5T至0.75T。编号⑤的一行数据表示且只表示齿盘沿逆时针方向转过一个周期T内的第一个1/4周期,即0至0.25T。连续变化的应变读数与三态值配合,监测齿盘的旋转状态。Choose a tri-state value combination from Table 1 as the starting point to determine the rotation state of the chainring. For the sake of clarity, choose the
3)测定可动臂的位移量:用数控器控制测微丝杆9转动,将可动臂16调整到测微丝杆9上的某一指定位置或任意位置,将该位置记作为可动臂16的位移原点,将此时齿盘22的位置记作齿盘零位。使齿盘22从齿盘零位开始转动,可动臂16随之从位移原点起发生位移。用S表示可动臂16相对于位移原点的位移量,并将其定义为赖原点位移,用公式(3)计算S:3) Measure the displacement of the movable arm: use the numerical controller to control the rotation of the
式(3)中,t表示测微丝杆9的导程,Nc表示齿盘22的齿数,nz,s表示齿盘22自齿盘零位起顺时针累计转过的齿数,nz,n表示齿盘22自齿盘零位起逆时针累计转过的齿数,nz,s和nz,n恒取正值。nz表示nz,s与nz,n之差,定义为有效转动齿数。nz,s、nz,n和nz也称为齿盘转动参数。nz和S是代数量。齿盘22顺时针转动时,可动臂16向右移动,nz和S的符号均为“-”。齿盘22逆时针转动时,可动臂16向左移动,nz和S的符号均为“+”。In formula (3), t represents the lead of the
本设计的机械手,其使用方法如下:The manipulator designed in this design is used as follows:
1)测量线路连接。将电阻应变计R1、R2、R3、R4组成的全桥测量电路与数控器连接,该电路既用于力的传感测量,又用于长度的传感测量。用于测力时,数控器测得的应变读数用εrf表示;用于测长度时,数控器测得的应变读数用εrd表示。1) Measure the line connection. A full-bridge measuring circuit composed of resistance strain gauges R 1 , R 2 , R 3 , and R 4 is connected to the numerical controller. The circuit is used for both force sensing measurement and length sensing measurement. When used for measuring force, the strain reading measured by the numerical control device is expressed by ε rf ; when used for measuring length, the strain reading measured by the numerical control device is expressed by ε rd .
2)测力系统标定。一般采用标准负荷传感器或标准测力环做为力值标准器,用夹持臂上的夹持器夹持力值标准器,对测力系统进行标定。以图1所示的面接触型夹持器为例,标定时,用可动臂16上左的左夹面18和固定臂17上的右夹面19夹持标准负荷传感器或标准测力环,由数控器控制可动臂16移动,对可动臂16和固定臂17施加一组标准力F1,F2,…,FN,(F1<F2<…,<FN,N为不小于2的正整数,取值范围根据需要确定,例如取2≤N≤10),同时由数控器记下与F1,F2,…,FN对应的应变读数 然后以为标定数,用力F与应变读数εrf的函数关系,即式(4)计算力F:2) Calibration of the force measuring system. Generally, a standard load cell or a standard force measuring ring is used as the force value standard device, and the force value standard device is clamped by the gripper on the clamping arm to calibrate the force measuring system. Taking the surface contact type gripper shown in FIG. 1 as an example, when calibrating, use the
式(4)中,A1和B1是常数,分别按公式(5)和(6)计算:In formula (4), A 1 and B 1 are constants, which are calculated according to formulas (5) and (6) respectively:
式(5)和(6)中,N表示标准力的序数,Fi表示不同序数标准力的力值,表示与力Fi对应的应变读数,即标定数标定中,弹性梁在标准力FN作用下产生的最大应力不得超过所用材料的比例极限。In equations (5) and (6), N represents the ordinal number of the standard force, F i represents the force value of the standard force with different ordinal numbers, Represents the strain reading corresponding to the force F i , i.e. the calibration number During calibration, the maximum stress generated by the elastic beam under the standard force F N shall not exceed the proportional limit of the material used.
3)测长度系统标定。首先根据夹持器类型选择长度标准器,标准直径规和标准厚度规是常用的长度标准器。标准直径规为一组不同直径的标准圆柱,用于线接触型夹持器和面接触型夹持器。标准厚度规为一组不同厚度的标准厚度块规,用于点接触型夹持器,亦可用于线接触型夹持器和面接触型夹持器。各标准圆柱或标准块规的厚度值依次用d0,d1,d2…,dn表示,d0<d1<d2,...,<dn,n表示标准圆柱或标准块规的数量,一般取2≤n≤10(例如取n=7)。d0,d1,d2,…,dn也表示对应的标准圆柱或标准块规。以图6(a)所示的点接触型夹持器为例,说明标定方法。采用标准厚度规为标准器,标准块规的厚度值应满足条件:当夹持臂的弹性梁在截面e处的挠度λ=dn-d0时,梁的最大应力不超过所用材料的比例极限。标定分四步进行:第一步,为应变读数εrd预设一个初始值一般在5με~20με范围内取值,例如取第二步,取标准块规d0,用数控器控制可动臂16移动,由第一夹持顶针36和第二夹持顶针37夹持d0,当应变读数时,可动臂16停止移动,将可动臂16的当前位置记作位移原点,将齿盘22的当前位置记作齿盘零位;第三步,用标准块规d1,d2…,dn依次替换d0,重复完成第二步动作,记下相应的应变读数第四步,以 为标定数,按长度s与应变读数εrd的函数关系,即式(7)计算长度s:3) Calibration of length measuring system. First select a length standard according to the type of holder, standard diameter gauge and standard thickness gauge are commonly used length standards. A standard diameter gauge is a set of standard cylinders of different diameters for use with line contact grippers and face contact grippers. Standard thickness gauges are a set of standard thickness block gauges of different thicknesses for point contact grippers, line contact grippers and surface contact grippers. The thickness value of each standard cylinder or standard block gauge is represented by d 0 , d 1 , d 2 . The number of gauges generally takes 2≤n≤10 (for example, n=7). d 0 , d 1 , d 2 , ..., dn also represent the corresponding standard cylinder or standard block gauge. The calibration method will be described by taking the point contact type gripper shown in Fig. 6(a) as an example. The standard thickness gauge is used as the standard, and the thickness value of the standard block gauge should meet the conditions: when the deflection of the elastic beam of the clamping arm at the section e is λ=d n -d 0 , the maximum stress of the beam does not exceed the proportion of the material used limit. The calibration is performed in four steps: In the first step, an initial value is preset for the strain reading ε rd Generally, the value is in the range of 5με~20με, for example, take In the second step, take the standard block gauge d 0 , use the numerical controller to control the movement of the
式(7)中,A2和B2是常数,分别用公式(8)和(9)计算:In formula (7), A 2 and B 2 are constants, which are calculated by formulas (8) and (9), respectively:
式(8)和(9)中,n表示标准厚度块规的个数,di表示不同厚度标准厚度块规的厚度值,表示与di对应的应变读数,即标定数 In formulas (8) and (9), n is the number of standard thickness gauges, d i is the thickness value of standard thickness gauges with different thicknesses, Indicates the strain reading corresponding to d i , that is, the calibration number
以上式(4)和式(9)都是用线性拟合方法推导得出的。进行测力系统标定和测长度系统标定时,可以设计力值标准器定位装置和长度标准器定位装置,以便于正确安装这两种标准器。The above equations (4) and (9) are both derived by the linear fitting method. When calibrating the force measuring system and the length measuring system, it is possible to design a force standard device positioning device and a length standard device positioning device to facilitate the correct installation of these two standard devices.
4)夹持测量作业。机械手通过联轴器2与机器人联接,在数控器的控制下进行夹持测量作业。以图1所示的面接触型夹持器为例,来说明作业过程。为简单起见,设物体W为刚体,且位置固定。作业过程分为五步:第一步,调整机械手的位置和两夹面的间距s,使s大于物体W的长度m,物体W进入两夹面之间;第二步,控制第一驱动器6转动,使固定臂17随滑动机架26向左移动,右夹面19与物体W接触,当应变读数时,停止第一驱动器6的转动;第三步,控制第二驱动器7转动,使可动臂16向右移动,右夹面19与物体W接触,当应变读数时,停止第二驱动器7的转动;第四步,控制第一驱动器6和第二驱动器7同时转动,使可动臂16和固定臂17同步相向移动,当应变读数εrd取得范围的任何一值εrdx时,记下εrdx、对应于εrdx的应变读数εrf和赖原点位移S;第五步,将εrf代入式(4),将εrdx和S代入公式(10):4) Clamping and measuring operations. The manipulator is connected with the robot through the
式(4)给出物体W受到的夹持力F,式(10)给出物体W的长度m。Equation (4) gives the clamping force F of the object W, and Equation (10) gives the length m of the object W.
对于弹簧、橡胶等变形物体,可以测量变形量。以压缩弹簧为例,采用面接触型夹持器。测量程序分为三步:第一步,设定一个应变读数例如设做为测量起点;第二步,用数控器控制夹持器夹持弹簧,使应变读数记下和与之对应的赖原点位移S*;第三步,增大夹持力F,跟踪记录F、应变读数εrd和赖原点位移S,按式(11)计算弹簧的变形量ν:For deformed objects such as springs and rubber, the amount of deformation can be measured. In the case of a compression spring, a surface contact type holder is used. The measurement procedure is divided into three steps: The first step is to set a strain reading For example, let As the starting point of measurement; in the second step, use the CNC to control the gripper to clamp the spring to make the strain reading Write down and the corresponding origin displacement S * ; in the third step, increase the clamping force F, track and record F, the strain reading ε rd and the origin displacement S, and calculate the spring deformation ν according to formula (11):
利用测量软件,可以绘制力-变形关系曲线,即F-ν曲线。Using the measurement software, the force-deformation relationship curve, that is, the F-ν curve, can be drawn.
对于高分子材料制品、植物果实、动物器官等类物体,可以测量压入变形。设物体W为球形体或正六面形体,使用如图6(a)所示的夹持顶针,测量夹持顶针压入物体W的深度。先设定一个应变读数例如设做为测量起点。测量时,控制夹持器夹物体W,先使应变读数记下和与之对应的赖原点位移S*,然后增大夹持力F,跟踪记录F、εrd和赖原点位移S,按式(12)计算压入深度δ:For polymer material products, plant fruits, animal organs and other objects, the indentation deformation can be measured. Suppose the object W is a spherical body or a regular hexahedron, and use the clamping thimble as shown in Figure 6(a) to measure the depth of the clamping thimble pressed into the object W. Set a strain reading first For example, let as a starting point for measurement. When measuring, control the gripper to clamp the object W, and make the strain reading first Write down and the corresponding displacement S * at the origin, then increase the clamping force F, track and record F, ε rd and displacement S at the origin, and calculate the indentation depth δ according to formula (12):
利用测量软件,可以绘制力-压入深度关系曲线,即F-δ曲线。F、ν、δ以及S均可作为控制参数,从而实现对机械手不同方式的控制。Using the measurement software, the force-indentation depth relationship curve, that is, the F-delta curve, can be drawn. F, ν, δ, and S can be used as control parameters, so as to realize the control of the manipulator in different ways.
Claims (1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911001461.XA CN110788874B (en) | 2019-10-21 | 2019-10-21 | Manipulator for controlling gripping force measurement gripping point spacing |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911001461.XA CN110788874B (en) | 2019-10-21 | 2019-10-21 | Manipulator for controlling gripping force measurement gripping point spacing |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110788874A true CN110788874A (en) | 2020-02-14 |
CN110788874B CN110788874B (en) | 2021-06-01 |
Family
ID=69440529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911001461.XA Active CN110788874B (en) | 2019-10-21 | 2019-10-21 | Manipulator for controlling gripping force measurement gripping point spacing |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110788874B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115312333A (en) * | 2022-08-03 | 2022-11-08 | 广东中慧高新科技有限公司 | High-precision capacitor machining system and method |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE7414048L (en) * | 1973-11-09 | 1975-05-12 | Boehringer Gmbh Geb | |
CN201421426Y (en) * | 2009-03-27 | 2010-03-10 | 吉林大学 | Ultra-precise cross-scale in-situ nano-indentation scoring test system |
CN101716701A (en) * | 2009-12-10 | 2010-06-02 | 哈尔滨工业大学 | Method for realizing swing welding with laser-GMA electric arc hybrid welding device |
CN207718191U (en) * | 2018-01-08 | 2018-08-10 | 白志青 | A kind of trace liquid quantitative determines the control system of journey injection |
DE102017210213A1 (en) * | 2017-06-19 | 2018-12-20 | Kuka Deutschland Gmbh | Gripper with a sensor on a gearbox bearing of the gripper |
-
2019
- 2019-10-21 CN CN201911001461.XA patent/CN110788874B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE7414048L (en) * | 1973-11-09 | 1975-05-12 | Boehringer Gmbh Geb | |
CN201421426Y (en) * | 2009-03-27 | 2010-03-10 | 吉林大学 | Ultra-precise cross-scale in-situ nano-indentation scoring test system |
CN101716701A (en) * | 2009-12-10 | 2010-06-02 | 哈尔滨工业大学 | Method for realizing swing welding with laser-GMA electric arc hybrid welding device |
DE102017210213A1 (en) * | 2017-06-19 | 2018-12-20 | Kuka Deutschland Gmbh | Gripper with a sensor on a gearbox bearing of the gripper |
CN207718191U (en) * | 2018-01-08 | 2018-08-10 | 白志青 | A kind of trace liquid quantitative determines the control system of journey injection |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115312333A (en) * | 2022-08-03 | 2022-11-08 | 广东中慧高新科技有限公司 | High-precision capacitor machining system and method |
CN115312333B (en) * | 2022-08-03 | 2023-06-13 | 广东中慧高新科技有限公司 | High-precision capacitor processing system and method |
Also Published As
Publication number | Publication date |
---|---|
CN110788874B (en) | 2021-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110672052B (en) | Flexible method and device for measuring thickness | |
CN110631466B (en) | Method and device for measuring diameter with cantilever beam sensor and coded screw rod | |
US11513043B2 (en) | Double cantilever beam-encoding lead screw combined sensing tensile test method and machine | |
CN110744577B (en) | Manipulator for controlling clamping deformation | |
CN110160454A (en) | A kind of bearing assembly clearance on-line measurement machine and its clearance measurement method | |
CN104990707B (en) | A Method of Accurate Inversion of Cylindrical Gear Parameters | |
CN110788874A (en) | Manipulator for controlling clamping force to measure distance between clamping points | |
KR101220111B1 (en) | Apparatus for measuring backlash | |
CN110470195B (en) | Apparatus and method for measuring gauge length after fracture of tensile specimen | |
CN106216440A (en) | A kind of aero-engine main shaft Intelligent Measurement corrector | |
CN103308016B (en) | Screw detector micro-displacement sensor driving mechanism and equilibrium state control method thereof | |
CN108613614A (en) | A kind of straight stroke valve actuator mechanic transmission clearance detection device and method | |
CN110900305B (en) | A method for measuring the positioning error of a machine tool table | |
CN111055167B (en) | Indexing two-link type ball rod instrument and method for detecting machine tool precision by using same | |
CN110567358B (en) | Method and device for measuring diameter with double-acting cantilever beam sensor | |
CN112747842A (en) | Composite stress sensor applying nonlinear elastic modulus material and detection method | |
CN105115465B (en) | A kind of measuring method and device of cycloid gear flank profil normal error | |
CN110441150B (en) | Double-movable-arm material tensile test method and test machine thereof | |
CN112692830B (en) | Three-dimensional angular displacement six-degree-of-freedom sensor system, measuring method and manipulator | |
CN102513880B (en) | Main shaft rotation error measurement aligning device based on sensor self-sensing | |
CN107621234B (en) | High-precision ultra-micro force measurement part surface shape tracking device | |
CN113547493B (en) | Automatic leveling method for working platform | |
CN211235257U (en) | Double Cantilever Beam-Coded Screw Composite Sensing Tensile Testing Machine | |
CN205664757U (en) | Measure instrument of work piece internal diameter | |
CN110657740B (en) | Method and device for measuring thickness of material sample |
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 |