WO2023142215A1 - Method for automatically picking up nanowires by micro-nano operation robot on basis of dynamic motion primitives - Google Patents

Method for automatically picking up nanowires by micro-nano operation robot on basis of dynamic motion primitives Download PDF

Info

Publication number
WO2023142215A1
WO2023142215A1 PCT/CN2022/078316 CN2022078316W WO2023142215A1 WO 2023142215 A1 WO2023142215 A1 WO 2023142215A1 CN 2022078316 W CN2022078316 W CN 2022078316W WO 2023142215 A1 WO2023142215 A1 WO 2023142215A1
Authority
WO
WIPO (PCT)
Prior art keywords
meta
task
micro
motion
trajectory
Prior art date
Application number
PCT/CN2022/078316
Other languages
French (fr)
Chinese (zh)
Inventor
杨湛
韩驰瑞
巢沛栋
房梁
张略
孙立宁
Original Assignee
苏州大学
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 苏州大学 filed Critical 苏州大学
Publication of WO2023142215A1 publication Critical patent/WO2023142215A1/en

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T1/00General purpose image data processing
    • G06T1/0014Image feed-back for automatic industrial control, e.g. robot with camera
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T5/00Image enhancement or restoration
    • G06T5/20Image enhancement or restoration by the use of local operators
    • G06T5/30Erosion or dilatation, e.g. thinning
    • G06T5/70
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/10Segmentation; Edge detection
    • G06T7/136Segmentation; Edge detection involving thresholding
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/215Motion-based segmentation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/10Image acquisition modality
    • G06T2207/10056Microscopic image
    • G06T2207/10061Microscopic image from scanning electron microscope
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30241Trajectory
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Definitions

  • the invention relates to the technical field of robot automation, in particular to a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives.
  • SEM Scanning Electron Microscope
  • These robots are assembled in the cavity of the SEM, and their overall dimensions are very small, usually on the order of a few centimeters.
  • the operating objects of the micro-nano manipulator are usually at the micron and nanometer level. In order to ensure normal operation, the motion accuracy needs to be guaranteed at the nanometer level.
  • the contact between the probe tip and the substrate can be detected, and the relative vertical position of the probe tip and the nano-object to be manipulated can also be determined, which can be based on the SEM image.
  • the design scheme of macro-robot automation mainly adopts the trajectory-based demonstration learning method, which generally needs to segment the trajectory to improve the learning efficiency of the trajectory.
  • the automatic segmentation trajectory is mainly divided into supervised segmentation and unsupervised methods.
  • the supervised segmentation method It is a segmentation technology based on shape matching, contacting the motion trajectory model trained in advance, and segmenting the teaching trajectory through the geometric shape and other features between the trajectory; one of the segmentation demonstration trajectory in the unsupervised segmentation method is to divide the robot end effector
  • the contact keyframe with the operating object is used as the split point to complete the split of the track.
  • the above-mentioned general demonstration motion trajectory segmentation methods are basically used in the field of macro-robots.
  • the technical problem to be solved by the present invention is to overcome the problems existing in the prior art, and to propose a method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives.
  • the present invention provides a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives, including the following steps:
  • S30 Encode the meta-task and establish a meta-task library.
  • the micro-nano operation robot calls the meta-task in the meta-task library, moves according to the trajectory of the meta-task, and completes Nanowire automatic pickup tasks.
  • obtaining the demo track of the micro-nano manipulator includes:
  • a low-pass Gaussian filter is selected to filter each frame of image, and the filtered image is etched and binarized successively to obtain the outlines of the cantilever beam and the nanowire in the image.
  • using the evaluation function to judge whether there is depth motion information on the demo trajectory of the micro-nano manipulator includes:
  • the Tenengrad gradient function is used as the evaluation function, and the Tenengrad gradient function is used to calculate the sharpness changes of the cantilever beam when it is stationary and in depth motion, and the polynomial regression model is used for characterization, and the corresponding slope is obtained to judge whether the cantilever beam is in depth. Motion or stillness.
  • the demonstration trajectory of the micro-nano manipulator robot is divided into a plurality of simple meta-tasks, wherein the division criterion of the meta-tasks includes:
  • Segmenting a segment of the track for deep motion on the demo track defining the motion as an ascending element task, before performing the ascending element task, moving the cantilever beam directly below the nanowire, and defining the motion as a positioning element task;
  • encoding the meta-task includes:
  • the trajectory of the meta-task is filtered, and Platts dynamic time warping is used to perform trajectory alignment processing on the trajectory of the filtered meta-task, and multiple trajectories are normalized to the same time step;
  • a Gaussian mixture model is used to characterize the motion characteristics of the meta-task after trajectory alignment processing, and a mixture of Gaussian regression generalization is used to generate the meta-task demonstration trajectory;
  • Meta-task demonstration trajectories are encoded using dynamic motion primitives.
  • the meta-task includes a divided meta-task and an introduced empty walk demonstration meta-task.
  • the formula of the Platts dynamic time warping is as follows:
  • the present invention also provides a computer device, including a memory, a processor, and a computer program stored on the memory and operable on the processor, and the processor implements the steps of the above-mentioned method when executing the program.
  • the present invention also provides a computer-readable storage medium, on which a computer program is stored, and when the program is executed by a processor, the steps of the above-mentioned method are realized.
  • the present invention proposes a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives. Aiming at the operating environment and motion characteristics of the micro-nano operating robot, it establishes a criterion for dividing element tasks, and divides complex operating trajectories into multiple A simple meta-task trajectory greatly reduces the learning difficulty of micro-nano manipulator robots, and is suitable for robot operations in micro-environment.
  • Fig. 1 is a schematic flowchart of the method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives in the present invention.
  • Fig. 2 is the sharpness change and polynomial regression characterization results of the AFM cantilever beam of the present invention in different states, wherein Fig. 2 (a) is the sharpness change and polynomial regression characterization results of the AFM cantilever beam at rest; Fig. 2 (b) is the AFM Characterization results of sharpness change and polynomial regression during the depth motion of the cantilever beam.
  • Fig. 3 is three contact states of the nanowire of the present invention and the AFM cantilever beam.
  • Fig. 4 is a motion track diagram of the demonstration end effector of the micro-nano manipulation robot picking up nanowires of the present invention.
  • Fig. 5 is a schematic diagram of the meta-tasks of the depth motion divided by the present invention.
  • Fig. 6 is a schematic diagram illustrating the division of a complete nanowire pick-up task according to the present invention.
  • Figure 7(a) is the original trajectory diagram of the positioning meta-task
  • Figure 7(b) is the original trajectory diagram of the positioning meta-task after filtering.
  • Fig. 8 is an effect diagram of aligning multiple positioning unit task trajectories in the present invention, the left side is before alignment, and the right side is after alignment.
  • Fig. 9 is the meta-task demonstration trajectory after learning in the present invention, the upper half of which is GMM characterizing the motion characteristics of positioning meta-task, and the lower half is the most stable trajectory graph generated by GMR generalization.
  • Fig. 10 is a trajectory diagram of the DMP recurring positioning meta-task demonstration in the present invention.
  • present embodiment provides a kind of micro-nano operation robot based on dynamic motion primitive to pick up nanowire method automatically, comprises the following steps:
  • S30 Encode the meta-task and establish a meta-task library.
  • the micro-nano operation robot calls the meta-task in the meta-task library, moves according to the trajectory of the meta-task, and completes Nanowire automatic pickup tasks.
  • the micro-nano operation robot is built in the SEM, and the end effector is an atomic force microscope (Atom Force Microscope). Microscope, AFM) probe, but what can be seen in the SEM image is the cantilever beam of the AFM probe.
  • the operator manipulates the control handle and the controller to control the movement of the micro-nano manipulating robot.
  • the cantilever beam of the AFM probe can be recognized through the image, and the trajectory of the cantilever beam of the probe can be calculated to obtain the demonstration trajectory of the end effector.
  • the main processing process is: obtain the motion video of the operation demonstration, intercept multiple frames of images on the motion video, filter each frame of image with a low-pass Gaussian filter, and use the morphological operation on the filtered image to convert the finer nano
  • the wires are etched away so that the probes can also be identified when they overlap the nanowires.
  • the image was then binarized using automatic histogram thresholding, enabling the profile of the probe cantilever and nanowires to be captured in the image. Due to the disorder of the nanowires, its profile changes greatly, but the profile of the probe cantilever does not change significantly, so the cantilever of the probe can be identified by polygonal approximation.
  • the shape of the cantilever is very similar to an isosceles trapezoid, so choose the X coordinate of the short side of the cantilever as the X coordinate of the cantilever, and the Y coordinate of the centroid of the profile as the Y coordinate of the cantilever.
  • the method adopted in the present invention is to analyze the Z-axis motion of the end effector AFM cantilever by judging the change of the definition of the cantilever beam.
  • the definition change of the AFM cantilever beam area is calculated, so the present invention expands according to the matched AFM tip area, and selects a fixed size area to calculate the definition change of the AFM cantilever beam, that is, the present invention uses the Tenengrad gradient function as the evaluation Clarity evaluation function.
  • the Tenengrad gradient function uses the Sobel operator to extract the gradient value of the horizontal and vertical directions of the image pixel, which is defined as the sum of the squares of the gradient of the pixel, and sets the sensitivity of a threshold adjustment function for the gradient.
  • the expression is:
  • T is a given edge detection threshold
  • G(x, y) is the gradient at the pixel point (x, y)
  • Gx and Gy are the convolution of Soble horizontal and vertical edge detection operators at the pixel point respectively.
  • the SEM image is an image containing two-dimensional information, and the depth information of the Z axis cannot be directly obtained. And researchers can't judge the relative information of the Z axis when manipulating the micro-nano robot, so the plane operation and the depth operation are separated, which is a good segmentation point, and the segmented segments can also be easily given Reasonable semantic interpretation.
  • the depth motion is segmented first. The plane movement occurs on the XY plane, and the XY trajectory changes drastically at this time, while the depth movement occurs on the Z axis.
  • the AFM cantilever beam moves in the Z axis, the distance between its upper surface and the SEM objective lens will change, resulting in a change in the definition of the cantilever beam in the SEM image. Therefore, by evaluating the clarity through the above-mentioned Tenengrad gradient function, it is possible to calculate the changes in the clarity of the AFM cantilever when it is stationary and in deep motion, and use polynomial regression to characterize the two changes, such as As shown in Fig. 2, for example, the
  • the present invention divides a segment of the track for deep motion on the demonstration track, and defines the motion as an ascending meta-task.
  • the cantilever beam is moved directly below the nanowire , define this movement as a positioning element task; after controlling the cantilever beam to rise, what you can see from the image is the top view of the nanowire and the cantilever beam, and there is an overlapping state between them, but their positional relationship in the Z-axis direction we If it cannot be known, it is impossible to accurately judge whether it is in contact with the nanowire.
  • the present invention increases the short-distance swing motion of the cantilever beam in the Y direction, and defines this motion as a contact judgment meta-task (a priori meta-task).
  • the contact judgment meta-task judges the contact state between the cantilever beam and the nanowire. After the contact judgment, the contact state between the nanowire and the cantilever beam can be obtained, which is divided into three contact states: line contact, point contact a, point contact Contact b, as shown in Figure 3.
  • the present invention defines these two contact repairs as two priori meta-tasks according to the difference between the two types of line contacts, which are respectively contact repair meta-task a and contact repair unit Task b.
  • contact repair is an action that occurs between two contact judgments.
  • the present invention can further divide these two meta-tasks, so as to obtain multiple relatively simple meta-tasks, which greatly reduces the difficulty for robots to learn these meta-tasks.
  • the present invention encodes the trajectories of these meta-tasks, so that the micro-nano Manipulating the robot learns and reproduces the motion of these meta-tasks.
  • the divided meta-tasks may not be representative enough, so the present invention also introduces the empty-walk demonstration meta-task of the micro-nano manipulator to increase the teaching ability of the meta-task demonstration.
  • GMM Gaussian Mix Model
  • BIC Bayesian Information Criterion
  • GMR Gaussian Mix Regression
  • the dynamic motion primitive transforms an easy-to-understand simple attractor system into a desired attractor system using a learnable forcing function term, which can work for point attractors and limit cycle attractors of almost any complexity, Has good coordination and stability.
  • DMP is used to encode the optimal meta-task trajectory, and a meta-task library is established.
  • the subsequent automatic execution task is that the micro-nano operation robot calls the meta-task DMP corresponding to the meta-task library, which is generated according to the DMP plan trajectory for movement.
  • One of the one-dimensional DMP equations is:
  • the first half of the first formula is the derivation equation of the spring damping model.
  • f is the interference item.
  • the third formula is the canonical system, x will decay to 0 before the end of the motion, so as not to affect the position of the target, so DMP can reproduce the generalized GMR very accurately track.
  • the present invention establishes a criterion for dividing meta-tasks, and divides complex operation trajectories into a plurality of simple meta-task trajectories, which greatly reduces the learning difficulty of micro-nano manipulating robots, and is applicable to micro-manipulators. environment for robot operation.
  • the present invention uses the sharpness evaluation function to calculate the change of the sharpness of the end effector of the micro-nano manipulator robot during the deep motion, to analyze the movement of the micro-nano manipulator robot during the deep motion, and can distinguish between motion and static states.
  • the present invention clusters different trajectories of the same divided meta-task, and performs code learning for each type of trajectories, and uses different meta-task trajectories in different scenarios to better complete the operation task.
  • the present invention uses the segmented simple meta-task trajectory as teaching, obtains the most stable teaching trajectory through a series of optimization processes, and then uses DMP to encode and learn this trajectory, greatly reducing The error between the trajectory generated by the DMP planning and the demonstration trajectory is minimized.
  • the operator manually controls the handle to complete the task of picking up the nanowires, and obtains a demonstration motion video. For each frame of image intercepted from the motion video, there are many noise points. After comparison and verification, the low-pass Gaussian filter is used for processing, and then a circular nucleus with a size of 1 is selected to corrode the nanowires in the SEM image. Then calculate the pixel values of all pixels in the image. Since the background accounts for most of the area in the image, the pixel value with the largest ratio is counted as the threshold, and the binary segmentation is performed, and the AFM cantilever beam and the nanowire substrate are identified.
  • the contour of the AFM cantilever can be identified by the difference between the contours, and the position of the AFM cantilever can be calculated.
  • the continuous motion track of the XY plane of the micro-nano manipulator robot can be obtained, as shown in Figure 4.
  • the demonstration trajectory of the operator manually picking up the nanowire is divided: firstly, it is divided according to whether the depth movement is performed, and it can be found that the XY axis trajectory during the period from 32s to 252s is basically unchanged , and the jitter does not exceed 15 pixels, and the Teneggrad function is used to calculate the sharpness change during this period, and then the polynomial regression model is used to characterize it, and the slope is 0.036, which is determined to be a deep movement during this period.
  • This section is segmented out and named as rising meta-task according to its motion characteristics, as shown in Figure 5.
  • the present invention names this movement as the positioning meta-task, as shown in FIG. 6 .
  • the positioning meta-task After the ascent meta task, it is necessary to judge the contact state of the nanowire and the AFM cantilever beam.
  • the secondary electron image collected from the SEM shows the top view of the nanowire and the AFM cantilever beam. There is an overlapping state between them, but we cannot know their positional relationship in the Z-axis direction. Therefore, the short-distance swing motion of the cantilever beam in the Y direction can be increased.
  • the present invention defines the motion as a contact judgment meta-task. It is a back-and-forth motion, and the trajectory is also special. Using the particularity of the contact judgment trajectory, it is divided from the demonstration trajectory. As shown in Figure 6, a total of three contact judgment meta-tasks are divided. Between the two contact judgment meta-tasks is the contact repair meta-task, which is divided according to this temporal feature, as shown in Figure 6. The result of the last contact judgment must be determined as wire contact. At this time, it is necessary to control the AFM cantilever beam to pull the nanowire from the substrate.
  • This movement is defined as the separation element task in the present invention, as shown in FIG. 6 .
  • the present invention divides a complete nanowire picking task demonstration into six simple meta-tasks, so that learning these six meta-tasks for the micro-nano manipulation robot is definitely much easier than learning a complex complete demonstration task.
  • the embodiment of the present invention also provides a computer device, including:
  • a processor which is used to implement the steps of the above-mentioned method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives when executing a computer program.
  • the processor may be a central processing unit (Central Processing Unit, CPU), an application-specific integrated circuit, a digital signal processor, a field programmable gate array, or other programmable logic devices.
  • CPU Central Processing Unit
  • application-specific integrated circuit e.g., an application-specific integrated circuit
  • digital signal processor e.g., a field programmable gate array
  • field programmable gate array e.g., a field programmable gate array
  • the processor can call the program stored in the memory. Specifically, the processor can execute the operations in the embodiment of the method for automatically picking up nanowires by a micro-nano manipulation robot based on dynamic motion primitives.
  • the memory is used to store one or more programs, the programs may include program codes, and the program codes include computer operation instructions.
  • the memory may include high-speed random access memory, and may also include non-volatile memory, such as at least one magnetic disk storage device or other volatile solid-state storage devices.
  • the embodiment of the present invention also provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the above-mentioned dynamic motion primitive-based micro Steps in the method for automatically picking up nanowires by a nanomanipulator robot.
  • the embodiments of the present application may be provided as methods, systems, or computer program products. Accordingly, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present application may take the form of a computer program product embodied on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
  • computer-usable storage media including but not limited to disk storage, CD-ROM, optical storage, etc.
  • These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing apparatus to operate in a specific manner, such that the instructions stored in the computer-readable memory produce an article of manufacture comprising instruction means, the instructions
  • the device realizes the function specified in one or more procedures of the flowchart and/or one or more blocks of the block diagram.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Robotics (AREA)
  • Multimedia (AREA)
  • Manipulator (AREA)

Abstract

The present invention relates to a method for automatically picking up nanowires by a micro-nano operation robot on basis of dynamic motion primitives. The method comprises: acquiring a demonstration trajectory of a micro-nano operation robot; determining whether there is motion-in-depth information on the demonstration trajectory of the micro-nano operation robot, wherein if the determination result is "yes", the trajectory is motion in depth, and if the determination result is "no", the trajectory is motion in plane, and dividing the demonstration trajectory of the micro-nano operation robot into a plurality of simple meta-tasks, wherein a division criterion for the meta-tasks is that division is performed according to whether motion in depth is performed; and coding the meta-tasks and establishing a meta-task library, and the micro-nano operation robot calling the meta-tasks in the meta-task library and moving according to trajectories of the meta-tasks. In the present invention, with regard to the operating environment and motion features of a micro-nano operation robot, a complex operation trajectory is divided into a plurality of simple meta-task trajectories, thereby greatly reducing the learning difficulty for the micro-nano operation robot. The method is applicable to robot operation in a micro environment.

Description

基于动态运动基元的微纳操作机器人自动拾取纳米线方法A method for automatically picking up nanowires by a micro-nano manipulation robot based on dynamic motion primitives 技术领域technical field
本发明涉及机器人自动化技术领域,尤其是指一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法。The invention relates to the technical field of robot automation, in particular to a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives.
背景技术Background technique
在微观环境下借助扫描电子显微镜(Scanning Electron Microscope,SEM)搭建微纳操作机器人或者操作系统来完成纳米线的拾取。这些机器人组装在SEM的腔体内,其外形尺寸都非常小,通常在几个厘米。微纳操机器人的操作对象通常为微米和纳米级别,为了保证正常工作,运动精度都需要保证在纳米级别。以SEM作为视觉传感器,使用基于视觉的接触检测方法,可以检测探针尖端与基底之间的接触,还可以确定探针尖端和要操纵的纳米物体的相对垂直位置,以此可以基于SEM的图像建立带有前馈控制控制器的视觉伺服控制系统,用于多个微纳操纵器的闭环控制,可将探针精确地带到目标位置,通过这种基于视觉反馈的伺服控制方法可以实现一些纳米操作机器人的自动操作任务。In a microscopic environment, use a scanning electron microscope (Scanning Electron Microscope, SEM) to build a micro-nano operating robot or operating system to complete the picking of nanowires. These robots are assembled in the cavity of the SEM, and their overall dimensions are very small, usually on the order of a few centimeters. The operating objects of the micro-nano manipulator are usually at the micron and nanometer level. In order to ensure normal operation, the motion accuracy needs to be guaranteed at the nanometer level. Using the SEM as a vision sensor, using a vision-based contact detection method, the contact between the probe tip and the substrate can be detected, and the relative vertical position of the probe tip and the nano-object to be manipulated can also be determined, which can be based on the SEM image. Establish a visual servo control system with a feed-forward control controller for the closed-loop control of multiple micro-nano manipulators, which can bring the probe to the target position accurately, through this visual feedback-based servo control method, some nanometer Operate robots for automated manipulation tasks.
目前宏观机器人自动化的设计方案主要采取基于轨迹的演示学习方法,其一般需要分割轨迹来提高轨迹的学习效率,通常自动分割轨迹主要分为监督分割和非监督方法,其中监督分割方法中有一种方法为基于形状匹配的分割技术,接触提前训练好的运动轨迹模型,通过轨迹之间的几何形状等特征对示教轨迹进行分割;无监督分割方法中的一种分割演示轨迹是将机器人末端执行器与操作对象的接触关键帧作为分割点,完成轨迹的分割。但是上述通用的演示运动轨迹的分割方法基本上都是使用在宏观机器人领域当中,其 运动特性和与操作对象的物理变化与微纳操作机器人存在一定区别,微纳操作机器人的工作环境是在微观环境中,其操作对象和信息收集都需要借助扫描电子显微镜,通用的分割方法不适合直接应用在微纳操作机器人上。At present, the design scheme of macro-robot automation mainly adopts the trajectory-based demonstration learning method, which generally needs to segment the trajectory to improve the learning efficiency of the trajectory. Usually, the automatic segmentation trajectory is mainly divided into supervised segmentation and unsupervised methods. Among them, there is a method in the supervised segmentation method It is a segmentation technology based on shape matching, contacting the motion trajectory model trained in advance, and segmenting the teaching trajectory through the geometric shape and other features between the trajectory; one of the segmentation demonstration trajectory in the unsupervised segmentation method is to divide the robot end effector The contact keyframe with the operating object is used as the split point to complete the split of the track. However, the above-mentioned general demonstration motion trajectory segmentation methods are basically used in the field of macro-robots. There are certain differences between their motion characteristics and physical changes with the operating objects and micro-nano manipulators. In the environment, the objects to be manipulated and information to be collected require the help of a scanning electron microscope, and general segmentation methods are not suitable for direct application to micro-nano manipulation robots.
发明内容Contents of the invention
为此,本发明所要解决的技术问题在于克服现有技术存在的问题,提出一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法,。Therefore, the technical problem to be solved by the present invention is to overcome the problems existing in the prior art, and to propose a method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives.
为解决上述技术问题,本发明提供一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法,包括以下步骤:In order to solve the above-mentioned technical problems, the present invention provides a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives, including the following steps:
S10:获取操作人员操作微纳操作机器人完成纳米线拾取任务的演示轨迹;S10: Obtain the demonstration track of the operator operating the micro-nano operation robot to complete the nanowire picking task;
S20:利用评价函数判断所述微纳操作机器人的演示轨迹上是否有深度运动信息,若判断结果为是,则该段轨迹为深度运动,若判断结果为否,则该段轨迹为平面运动,并将所述微纳操作机器人的演示轨迹划分为多个简单的元任务,其中元任务的划分准则为根据是否进行深度运动进行划分;S20: Using the evaluation function to judge whether there is depth motion information on the demo trajectory of the micro-nano manipulator robot, if the judgment result is yes, then this section of trajectory is a depth movement, if the judgment result is no, then this section of trajectory is a planar movement, And the demonstration trajectory of the micro-nano manipulator is divided into a plurality of simple meta-tasks, wherein the division criterion of the meta-tasks is divided according to whether to carry out deep motion;
S30:对元任务进行编码并建立元任务库,在有纳米线自动拾取任务时,所述微纳操作机器人调用所述元任务库中的元任务,按照所述元任务的轨迹进行运动,完成纳米线自动拾取任务。S30: Encode the meta-task and establish a meta-task library. When there is a nanowire automatic picking task, the micro-nano operation robot calls the meta-task in the meta-task library, moves according to the trajectory of the meta-task, and completes Nanowire automatic pickup tasks.
在本发明的一个实施例中,在S10中,获取微纳操作机器人的演示轨迹包括:In one embodiment of the present invention, in S10, obtaining the demo track of the micro-nano manipulator includes:
获取微纳操作机器人的运动视频,在所述运动视频上截取多帧图像;Obtaining the movement video of the micro-nano operation robot, and intercepting multiple frames of images on the movement video;
选用低通高斯滤波器对每一帧图像进行滤波处理,并对滤波处理后的图像先后进行腐蚀和二值化处理,获得所述图像中的悬臂梁和纳米线的轮廓。A low-pass Gaussian filter is selected to filter each frame of image, and the filtered image is etched and binarized successively to obtain the outlines of the cantilever beam and the nanowire in the image.
在本发明的一个实施例中,在S20中,利用评价函数判断所述微纳操作机器人的演示轨迹上是否有深度运动信息包括:In one embodiment of the present invention, in S20, using the evaluation function to judge whether there is depth motion information on the demo trajectory of the micro-nano manipulator includes:
将Tenengrad梯度函数作为评价函数,利用Tenengrad梯度函数计算悬臂梁在静止不动和进行深度运动时各自的清晰度变化情况,使用多项式回归模型进行表征,得出对应的斜率,判断悬臂梁是否进行深度运动还是静止不动。The Tenengrad gradient function is used as the evaluation function, and the Tenengrad gradient function is used to calculate the sharpness changes of the cantilever beam when it is stationary and in depth motion, and the polynomial regression model is used for characterization, and the corresponding slope is obtained to judge whether the cantilever beam is in depth. Motion or stillness.
在本发明的一个实施例中,在S20中,将所述微纳操作机器人的演示轨迹划分为多个简单的元任务,其中元任务的划分准则为根据是否进行深度运动进行划分包括:In one embodiment of the present invention, in S20, the demonstration trajectory of the micro-nano manipulator robot is divided into a plurality of simple meta-tasks, wherein the division criterion of the meta-tasks includes:
将所述演示轨迹上进行深度运动的一段轨迹分割出来,将该运动定义为上升元任务,在执行上升元任务之前,将悬臂梁运动到纳米线正下方,将该运动定义为定位元任务;Segmenting a segment of the track for deep motion on the demo track, defining the motion as an ascending element task, before performing the ascending element task, moving the cantilever beam directly below the nanowire, and defining the motion as a positioning element task;
控制所述悬臂梁上升后增加悬臂梁在Y方向上的短距离摇摆的运动,并将该运动定义为接触判断元任务,根据所述接触判断元任务判断所述悬臂梁和纳米线的接触状态,若所述悬臂梁和纳米线的接触状态为线接触,则控制悬臂梁将纳米线拾取,并将该运动定义为分离元任务,若所述悬臂梁和纳米线的接触状态为点接触,则定义接触修复元任务对点接触进行修复,直至悬臂梁和纳米线的接触状态为线接触。After controlling the rise of the cantilever beam, increasing the short-distance swing motion of the cantilever beam in the Y direction, and defining this motion as a contact judgment meta-task, judging the contact state between the cantilever beam and the nanowire according to the contact judgment meta-task , if the contact state of the cantilever beam and the nanowire is line contact, then control the cantilever beam to pick up the nanowire, and define this motion as a separation element task, if the contact state of the cantilever beam and the nanowire is point contact, Then define the contact repair meta-task to repair the point contact until the contact state between the cantilever beam and the nanowire is line contact.
在本发明的一个实施例中,所述接触修复元任务为至少一个。In an embodiment of the present invention, there is at least one contact repair meta-task.
在本发明的一个实施例中,在S30中,对元任务进行编码包括:In one embodiment of the present invention, in S30, encoding the meta-task includes:
对所述元任务的轨迹进行滤波处理,并采用普氏动态时间规整对滤波处理后的元任务的轨迹进行轨迹对齐处理,将多个轨迹正则化到同一时间步长;The trajectory of the meta-task is filtered, and Platts dynamic time warping is used to perform trajectory alignment processing on the trajectory of the filtered meta-task, and multiple trajectories are normalized to the same time step;
采用高斯混合模型表征轨迹对齐处理后的元任务的运动特性,并采用混 合高斯回归泛化生成元任务演示轨迹;A Gaussian mixture model is used to characterize the motion characteristics of the meta-task after trajectory alignment processing, and a mixture of Gaussian regression generalization is used to generate the meta-task demonstration trajectory;
使用动态运动基元对元任务演示轨迹进行编码处理。Meta-task demonstration trajectories are encoded using dynamic motion primitives.
在本发明的一个实施例中,所述元任务包括划分的元任务和引入的空走演示元任务。In an embodiment of the present invention, the meta-task includes a divided meta-task and an introduced empty walk demonstration meta-task.
在本发明的一个实施例中,所述普氏动态时间规整的公式如下:In one embodiment of the present invention, the formula of the Platts dynamic time warping is as follows:
Figure PCTCN2022078316-appb-000001
Figure PCTCN2022078316-appb-000001
其中,
Figure PCTCN2022078316-appb-000002
为第i个需要对齐的轨迹,i=1,2,…,m,
Figure PCTCN2022078316-appb-000003
是时间正则化矩阵。
in,
Figure PCTCN2022078316-appb-000002
is the i-th track to be aligned, i=1,2,...,m,
Figure PCTCN2022078316-appb-000003
is the time regularization matrix.
此外,本发明还提供一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述所述方法的步骤。In addition, the present invention also provides a computer device, including a memory, a processor, and a computer program stored on the memory and operable on the processor, and the processor implements the steps of the above-mentioned method when executing the program.
并且,本发明还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述所述方法的步骤。Moreover, the present invention also provides a computer-readable storage medium, on which a computer program is stored, and when the program is executed by a processor, the steps of the above-mentioned method are realized.
本发明的上述技术方案相比现有技术具有以下优点:The above technical solution of the present invention has the following advantages compared with the prior art:
本发明提出了一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其针对微纳操作机器人的操作环境和运动特征,建立划分元任务的准则,将复杂的操作轨迹划分为多个简单的元任务轨迹,极大地降低了微纳操作机器人的学习难度,适用微观环境下的机器人操作。The present invention proposes a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives. Aiming at the operating environment and motion characteristics of the micro-nano operating robot, it establishes a criterion for dividing element tasks, and divides complex operating trajectories into multiple A simple meta-task trajectory greatly reduces the learning difficulty of micro-nano manipulator robots, and is suitable for robot operations in micro-environment.
附图说明Description of drawings
为了使本发明的内容更容易被清楚的理解,下面根据本发明的具体实施 例并结合附图,对本发明作进一步详细的说明。In order to make the content of the present invention easier to understand clearly, the present invention will be described in further detail below according to the specific embodiments of the present invention in conjunction with the accompanying drawings.
图1是本发明基于动态运动基元的微纳操作机器人自动拾取纳米线方法的流程示意图。Fig. 1 is a schematic flowchart of the method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives in the present invention.
图2是本发明AFM悬臂梁在不同状态下的清晰度变化和多项式回归表征结果,其中图2(a)为AFM悬臂梁静止时清晰度变化和多项式回归表征结果;图2(b)为AFM悬臂梁深度运动时清晰度变化和多项式回归表征结果。Fig. 2 is the sharpness change and polynomial regression characterization results of the AFM cantilever beam of the present invention in different states, wherein Fig. 2 (a) is the sharpness change and polynomial regression characterization results of the AFM cantilever beam at rest; Fig. 2 (b) is the AFM Characterization results of sharpness change and polynomial regression during the depth motion of the cantilever beam.
图3是本发明纳米线和AFM悬臂梁的三种接触状态。Fig. 3 is three contact states of the nanowire of the present invention and the AFM cantilever beam.
图4是本发明微纳操作机器人拾取纳米线演示末端执行器的运动轨迹图。Fig. 4 is a motion track diagram of the demonstration end effector of the micro-nano manipulation robot picking up nanowires of the present invention.
图5是本发明划分出的深度运动的元任务示意图。Fig. 5 is a schematic diagram of the meta-tasks of the depth motion divided by the present invention.
图6是本发明划分完整纳米线拾取任务的演示示意图。Fig. 6 is a schematic diagram illustrating the division of a complete nanowire pick-up task according to the present invention.
图7(a)是定位元任务原始轨迹图,图7(b)是滤波之后的定位元任务原始轨迹图。Figure 7(a) is the original trajectory diagram of the positioning meta-task, and Figure 7(b) is the original trajectory diagram of the positioning meta-task after filtering.
图8是本发明对齐多个定位元任务轨迹的效果图,左边为对齐之前,右边为对齐之后。Fig. 8 is an effect diagram of aligning multiple positioning unit task trajectories in the present invention, the left side is before alignment, and the right side is after alignment.
图9是本发明学习后的元任务演示轨迹,其上半部分为GMM表征定位元任务的运动特征,下半部分为GMR泛化生成最稳定的轨迹图。Fig. 9 is the meta-task demonstration trajectory after learning in the present invention, the upper half of which is GMM characterizing the motion characteristics of positioning meta-task, and the lower half is the most stable trajectory graph generated by GMR generalization.
图10是本发明DMP复现定位元任务演示轨迹图。Fig. 10 is a trajectory diagram of the DMP recurring positioning meta-task demonstration in the present invention.
具体实施方式Detailed ways
下面结合附图和具体实施例对本发明作进一步说明,以使本领域的技术人员可以更好地理解本发明并能予以实施,但所举实施例不作为对本发明的限定。The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments, so that those skilled in the art can better understand the present invention and implement it, but the examples given are not intended to limit the present invention.
请参阅图1所示,本实施例提供一种基于动态运动基元的微纳操作机器 人自动拾取纳米线方法,包括以下步骤:Please refer to shown in Fig. 1, present embodiment provides a kind of micro-nano operation robot based on dynamic motion primitive to pick up nanowire method automatically, comprises the following steps:
S10:获取操作人员操作微纳操作机器人完成纳米线拾取任务的演示轨迹;S10: Obtain the demonstration track of the operator operating the micro-nano operation robot to complete the nanowire picking task;
S20:利用评价函数判断所述微纳操作机器人的演示轨迹上是否有深度运动信息,若判断结果为是,则该段轨迹为深度运动,若判断结果为否,则该段轨迹为平面运动,并将所述微纳操作机器人的演示轨迹划分为多个简单的元任务,其中元任务的划分准则为根据是否进行深度运动进行划分;S20: Using the evaluation function to judge whether there is depth motion information on the demo trajectory of the micro-nano manipulator robot, if the judgment result is yes, then this section of trajectory is a depth movement, if the judgment result is no, then this section of trajectory is a planar movement, And the demonstration trajectory of the micro-nano manipulator is divided into a plurality of simple meta-tasks, wherein the division criterion of the meta-tasks is divided according to whether to carry out deep motion;
S30:对元任务进行编码并建立元任务库,在有纳米线自动拾取任务时,所述微纳操作机器人调用所述元任务库中的元任务,按照所述元任务的轨迹进行运动,完成纳米线自动拾取任务。S30: Encode the meta-task and establish a meta-task library. When there is a nanowire automatic picking task, the micro-nano operation robot calls the meta-task in the meta-task library, moves according to the trajectory of the meta-task, and completes Nanowire automatic pickup tasks.
在本发明公开的一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法中,对于上述实施方式的S10,微纳操作机器人搭建在SEM中的,末端执行器为原子力显微镜(Atom Force Microscope,AFM)探针,但在SEM图像中能看到的是AFM探针的悬臂梁。操作人员操纵控制手柄和控制器可以控制微纳操作机器人运动,通过图像识别出AFM探针的悬臂梁,可以计算出探针悬臂梁的运动轨迹从而获得末端执行器的演示轨迹。主要的处理过程为:获取操作演示的运动视频,在运动视频上截取多帧图像,对每一帧图像选用低通高斯滤波器进行滤波处理,过滤后的图像使用形态学操作将较细的纳米线腐蚀掉,这样在探针和纳米线重叠时也可识别出探针。接着使用自动直方图阈值化图像获得二值化图像,从而能够获取图像中探针悬臂梁和纳米线的轮廓。由于纳米线杂乱导致其轮廓变化较大,而探针悬臂梁的轮廓不会发生明显改变,即可通过多边形逼近来识别出探针的悬臂梁。悬臂梁的形状与等腰梯形非常相似,所以选择悬臂梁短边的X坐标作为悬臂梁的X坐标,轮廓的形心的Y坐标作为悬臂梁的Y坐标。In a method for automatically picking up nanowires by a micro-nano operation robot based on dynamic motion primitives disclosed in the present invention, for S10 of the above-mentioned embodiment, the micro-nano operation robot is built in the SEM, and the end effector is an atomic force microscope (Atom Force Microscope). Microscope, AFM) probe, but what can be seen in the SEM image is the cantilever beam of the AFM probe. The operator manipulates the control handle and the controller to control the movement of the micro-nano manipulating robot. The cantilever beam of the AFM probe can be recognized through the image, and the trajectory of the cantilever beam of the probe can be calculated to obtain the demonstration trajectory of the end effector. The main processing process is: obtain the motion video of the operation demonstration, intercept multiple frames of images on the motion video, filter each frame of image with a low-pass Gaussian filter, and use the morphological operation on the filtered image to convert the finer nano The wires are etched away so that the probes can also be identified when they overlap the nanowires. The image was then binarized using automatic histogram thresholding, enabling the profile of the probe cantilever and nanowires to be captured in the image. Due to the disorder of the nanowires, its profile changes greatly, but the profile of the probe cantilever does not change significantly, so the cantilever of the probe can be identified by polygonal approximation. The shape of the cantilever is very similar to an isosceles trapezoid, so choose the X coordinate of the short side of the cantilever as the X coordinate of the cantilever, and the Y coordinate of the centroid of the profile as the Y coordinate of the cantilever.
在本发明公开的一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法中,对于上述实施方式的S20,由于上述SEM拍摄到的图像是二维的灰度图,微纳操作机器人的深度方向即Z轴运动信息无法精准获取,因此本发明所采用的方法是通过判断末端执行器AFM悬臂梁的清晰度的变化情况来分析它的Z轴运动情况。由于SEM的视场中心拍摄到的范围是有限的,而悬臂梁的大小远远超过SEM的拍摄范围,操作过程中能看到的悬臂梁的面积是一直在变化的,不好采用整个画面中的AFM悬臂梁区域计算其清晰度变化,因此本发明根据匹配到的AFM尖端区域进行扩展,选择一个固定大小的区域来计算AFM悬臂梁的清晰度变化情况,即本发明采用Tenengrad梯度函数作为评价清晰度的评价函数。Tenengrad梯度函数采用Sobel算子提取图像像素点水平方向和垂直方向的梯度值,定义为像素点梯度的平方和,并为梯度设置了一个阈值调节函数的灵敏度,其表达式为:In the method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives disclosed in the present invention, for S20 of the above-mentioned embodiment, since the image captured by the above-mentioned SEM is a two-dimensional grayscale image, the micro-nano manipulating robot The depth direction, that is, the Z-axis motion information cannot be accurately obtained, so the method adopted in the present invention is to analyze the Z-axis motion of the end effector AFM cantilever by judging the change of the definition of the cantilever beam. Since the range captured by the center of the field of view of the SEM is limited, and the size of the cantilever beam is far beyond the shooting range of the SEM, the area of the cantilever beam that can be seen during the operation is always changing, so it is not easy to use the whole picture. The definition change of the AFM cantilever beam area is calculated, so the present invention expands according to the matched AFM tip area, and selects a fixed size area to calculate the definition change of the AFM cantilever beam, that is, the present invention uses the Tenengrad gradient function as the evaluation Clarity evaluation function. The Tenengrad gradient function uses the Sobel operator to extract the gradient value of the horizontal and vertical directions of the image pixel, which is defined as the sum of the squares of the gradient of the pixel, and sets the sensitivity of a threshold adjustment function for the gradient. The expression is:
Figure PCTCN2022078316-appb-000004
Figure PCTCN2022078316-appb-000004
Figure PCTCN2022078316-appb-000005
Figure PCTCN2022078316-appb-000005
其中,T是给定的边缘检测阈值,G(x,y)是像素点(x,y)处的梯度,Gx和Gy分别是像素点处Soble水平和垂直方向边缘检测算子的卷积。Among them, T is a given edge detection threshold, G(x, y) is the gradient at the pixel point (x, y), and Gx and Gy are the convolution of Soble horizontal and vertical edge detection operators at the pixel point respectively.
并且,SEM图像是一个包含二维信息的图像,对于其Z轴的深度信息无法直接获取。而研究人员在进行操纵微纳操作机器人时也无法判断Z轴的相对信息,因此平面操作和深度操作是分开来的,这是一个很好的分割点,分割出来的片段也可以很容易地赋予合理的语义解释。首先通过分析出深度运动与平面运动的转折点,将其做为分割的关键点,先分割出深度运动来。平面运动发生在XY平面,此时XY轨迹变化剧烈,而深度运动发生在Z轴上,这时的XY轨迹理论上是不变化的,但由于微纳操作机器人的三个驱动机构是连接在一起的,单独每个轴的在运动时都会带动其它轴的抖动,而且在SEM电镜中搭建机器人操作系统会干扰SEM的图像,这两个原因都会让AFM悬臂梁 在进行Z轴运动时,XY平面的位置产生微小地变化。经过多次实验测量,AFM悬臂梁的抖动范围在15个像素点以内。因此,可以根据X轴和Y轴轨迹的变化幅度来确定悬臂梁是否处于深度运动的状态。然而,这还需要区分悬臂梁的Z轴运动和真实静止两种状态。AFM悬臂梁在进行Z轴运动时,其上表面与SEM物镜的距离就会发生改变,产生的后果就是SEM图像中的悬臂梁的清晰度就会发生改变。因此通过上述的Tenengrad梯度函数评价清晰度,可以计算出AFM悬臂梁在静止不动和进行深度运动时两种情况下各自的清晰度的变化情况,并利用多项式回归表征这两种变化情况,如图2所示,例如悬臂梁静止时的清晰度评价变化的|k|小于0.003,而深度运动时悬臂梁清晰度评价变化的|k|都大于0.003,因此采用0.003作为阈值来区分悬臂梁是否进行Z轴运动还是静止不动。Moreover, the SEM image is an image containing two-dimensional information, and the depth information of the Z axis cannot be directly obtained. And researchers can't judge the relative information of the Z axis when manipulating the micro-nano robot, so the plane operation and the depth operation are separated, which is a good segmentation point, and the segmented segments can also be easily given Reasonable semantic interpretation. First, by analyzing the turning point between the depth motion and the plane motion, and using it as the key point of segmentation, the depth motion is segmented first. The plane movement occurs on the XY plane, and the XY trajectory changes drastically at this time, while the depth movement occurs on the Z axis. At this time, the XY trajectory does not change theoretically, but because the three driving mechanisms of the micro-nano manipulator are connected together Yes, each axis alone will drive other axes to vibrate when it moves, and building a robot operating system in the SEM electron microscope will interfere with the SEM image. These two reasons will make the AFM cantilever move in the Z-axis, XY plane position changes slightly. After many experiments and measurements, the shaking range of the AFM cantilever is within 15 pixels. Therefore, it can be determined whether the cantilever beam is in a state of deep motion according to the variation range of the X-axis and Y-axis trajectories. However, this also requires distinguishing between the Z-axis motion of the cantilever and the true rest state. When the AFM cantilever beam moves in the Z axis, the distance between its upper surface and the SEM objective lens will change, resulting in a change in the definition of the cantilever beam in the SEM image. Therefore, by evaluating the clarity through the above-mentioned Tenengrad gradient function, it is possible to calculate the changes in the clarity of the AFM cantilever when it is stationary and in deep motion, and use polynomial regression to characterize the two changes, such as As shown in Fig. 2, for example, the |k| of the definition evaluation change of the cantilever beam at rest is less than 0.003, while the |k| Perform Z-axis motion or stand still.
在划分出深度运动和平面运动后,但往往平面运动的轨迹较为复杂,需要对其进一步的划分。由于微纳操作的特殊性,本发明将所述演示轨迹上进行深度运动的一段轨迹分割出来,将该运动定义为上升元任务,在执行上升元任务之前,将悬臂梁运动到纳米线正下方,将该运动定义为定位元任务;控制所述悬臂梁上升后,从图像看到的是纳米线和悬臂梁的俯视图,它们之间是一个重叠状态,但是在Z轴方向上它们位置关系我们无法得知,就无法准确判断是否和纳米线接触,因此本发明增加悬臂梁在Y方向上的短距离摇摆的运动,并将该运动定义为接触判断元任务(先验的元任务),根据所述接触判断元任务判断所述悬臂梁和纳米线的接触状态,接触判断之后,可以得到纳米线和悬臂梁之间的接触状态,分为三种接触状态:线接触、点接触a、点接触b,如图3所示。若所述悬臂梁和纳米线的接触状态为线接触,则控制悬臂梁将纳米线拾取,并将该运动定义为分离元任务;若所述悬臂梁和纳米线的接触状态为点接触,此时两者之间的接触力非常小,可能不足以将纳米线从基底上拔出来(拾取)。针对这两种点接触需要进行相应的修正操作,因此本发明将这两个接触修复根据两种线接触地不同定义为两种先验的元任务,分别为接触修复元任务 a和接触修复元任务b。而接触修复后必要继续进行接触判断,所以接触修复是发生在两个接触判断之间的一个动作。基于这种时间上的特征,本发明可以进一步划分出这两个元任务,从而可以得到多个较为简单的元任务,大大地降低机器人学习这些元任务地难度。After dividing the depth motion and plane motion, the trajectory of plane motion is often more complicated, which needs to be further divided. Due to the particularity of the micro-nano operation, the present invention divides a segment of the track for deep motion on the demonstration track, and defines the motion as an ascending meta-task. Before performing the ascending meta-task, the cantilever beam is moved directly below the nanowire , define this movement as a positioning element task; after controlling the cantilever beam to rise, what you can see from the image is the top view of the nanowire and the cantilever beam, and there is an overlapping state between them, but their positional relationship in the Z-axis direction we If it cannot be known, it is impossible to accurately judge whether it is in contact with the nanowire. Therefore, the present invention increases the short-distance swing motion of the cantilever beam in the Y direction, and defines this motion as a contact judgment meta-task (a priori meta-task). The contact judgment meta-task judges the contact state between the cantilever beam and the nanowire. After the contact judgment, the contact state between the nanowire and the cantilever beam can be obtained, which is divided into three contact states: line contact, point contact a, point contact Contact b, as shown in Figure 3. If the contact state of the cantilever beam and the nanowire is line contact, then control the cantilever beam to pick up the nanowire, and define the motion as a separation element task; if the contact state of the cantilever beam and the nanowire is point contact, this When the contact force between the two is very small, it may not be enough to pull (pick up) the nanowire from the substrate. Corresponding correction operations are required for these two kinds of point contacts, so the present invention defines these two contact repairs as two priori meta-tasks according to the difference between the two types of line contacts, which are respectively contact repair meta-task a and contact repair unit Task b. However, contact judgment must be continued after contact repair, so contact repair is an action that occurs between two contact judgments. Based on this temporal feature, the present invention can further divide these two meta-tasks, so as to obtain multiple relatively simple meta-tasks, which greatly reduces the difficulty for robots to learn these meta-tasks.
在本发明公开的一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法中,对于上述实施方式的S30,元任务划分出来之后,本发明对这些元任务轨迹进行编码,让微纳操作机器人学习并复现这些元任务的运动。但是单单的划分出来的元任务可能还不够具有代表性,因此本发明还引入微纳操作机器人的空走演示元任务,增加元任务演示的示教能力。In a method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives disclosed in the present invention, for S30 in the above embodiment, after the meta-tasks are divided, the present invention encodes the trajectories of these meta-tasks, so that the micro-nano Manipulating the robot learns and reproduces the motion of these meta-tasks. However, the divided meta-tasks may not be representative enough, so the present invention also introduces the empty-walk demonstration meta-task of the micro-nano manipulator to increase the teaching ability of the meta-task demonstration.
在具体编码时,由于SEM图像会受到多种因素干扰加上微纳操作机器人的抖动,计算出的AFM悬臂梁的移动轨迹会有许多小幅度抖动,因此可以采用滑动平均滤波器对运动轨迹进行过滤处理。还有划分出的同一个元任务的多个轨迹之间的时间长度可能有差别,但是后续的处理需要时间长度一样的的轨迹,因此本发明采用普氏动态时间规整(Procrustes Dynamic Time Warping,PDTW)进行轨迹对齐处理。PDTW在原有动态时间规整的基础上进行修改,可以同时对齐多个轨迹,将多个轨迹正则化到同一时间步长,通过最小化:In the specific coding, since the SEM image will be disturbed by various factors and the jitter of the micro-nano manipulator, the calculated movement trajectory of the AFM cantilever beam will have many small-scale jitters, so the moving average filter can be used to analyze the movement trajectory. filter processing. There may be differences in the time length between multiple trajectories of the same meta-task divided, but the follow-up processing needs trajectories with the same time length, so the present invention adopts Procrustes Dynamic Time Warping (PDTW) ) for trajectory alignment. PDTW is modified on the basis of the original dynamic time warping. It can align multiple trajectories at the same time, and regularize multiple trajectories to the same time step. By minimizing:
Figure PCTCN2022078316-appb-000006
Figure PCTCN2022078316-appb-000006
其中,
Figure PCTCN2022078316-appb-000007
为第i个需要对齐的轨迹,i=1,2,…,m,
Figure PCTCN2022078316-appb-000008
是时间正则化矩阵。
in,
Figure PCTCN2022078316-appb-000007
is the i-th track to be aligned, i=1,2,...,m,
Figure PCTCN2022078316-appb-000008
is the time regularization matrix.
高斯混合模型(Gaussian Mix Model,GMM)是典型的演示学习算法,基于GMM的轨迹学习模型能够很好地保持AFM悬臂梁演示轨迹的形状特征。本发明使用K-means聚类方法和Bayesian Information Criterion(BIC)准则 确定参数的初值,并采用EM算法进行参数估计。参数计算好后,使用混合高斯回归(Gaussian Mix Regression,GMR)对已表征的GMM进行回归处理,对每一个元任务生成最可靠的轨迹。并且使用动态运动基元DMP对GMR生成的最稳定的轨迹进行编码。动态运动基元利用一个可学习的强迫函数项将一个易于理解的简单吸引子系统转化为一个期望的吸引子系统,可以对几乎任意复杂程度的点吸引子和极限环吸引子都能起作用,具有良好的协调能力和稳定性。在本发明方法中,对于最优的元任务轨迹采用DMP对其进行编码,并建立元任务库,后续的自动执行任务就是微纳操作机器人调用元任务库对应的元任务DMP,按照DMP规划生成的轨迹进行运动。其中一个一维的DMP方程为:Gaussian Mix Model (GMM) is a typical demonstration learning algorithm, and the trajectory learning model based on GMM can well maintain the shape characteristics of the demonstration trajectory of the AFM cantilever beam. The present invention uses K-means clustering method and Bayesian Information Criterion (BIC) criterion to determine the initial value of parameter, and adopts EM algorithm to carry out parameter estimation. After the parameters are calculated, Gaussian Mix Regression (GMR) is used to perform regression processing on the represented GMM to generate the most reliable trajectory for each meta-task. And the most stable trajectory generated by GMR is encoded using dynamic motion primitive DMP. The dynamic motion primitive transforms an easy-to-understand simple attractor system into a desired attractor system using a learnable forcing function term, which can work for point attractors and limit cycle attractors of almost any complexity, Has good coordination and stability. In the method of the present invention, DMP is used to encode the optimal meta-task trajectory, and a meta-task library is established. The subsequent automatic execution task is that the micro-nano operation robot calls the meta-task DMP corresponding to the meta-task library, which is generated according to the DMP plan trajectory for movement. One of the one-dimensional DMP equations is:
Figure PCTCN2022078316-appb-000009
Figure PCTCN2022078316-appb-000009
Figure PCTCN2022078316-appb-000010
Figure PCTCN2022078316-appb-000010
Figure PCTCN2022078316-appb-000011
Figure PCTCN2022078316-appb-000011
其中,第一个公式的前半段为弹簧阻尼模型推导方程,当α=4β时,轨迹会快速稳定地到达目标;f为干扰项,照示教轨迹数据用局部加权回归求基函数ψi的权重ωi,复现示教轨迹的形状;第三个公式为规范系统,x会在运动结束前衰减至0,从而不影响目标的的位置,因此DMP可以非常精确地复现GMR泛化后的的轨迹。Among them, the first half of the first formula is the derivation equation of the spring damping model. When α=4β, the trajectory will reach the target quickly and stably; f is the interference item. According to the teaching trajectory data, use local weighted regression to find the weight of the basis function ψi ωi, reproduces the shape of the teaching trajectory; the third formula is the canonical system, x will decay to 0 before the end of the motion, so as not to affect the position of the target, so DMP can reproduce the generalized GMR very accurately track.
本发明针对微纳操作机器人的操作环境和运动特征,建立划分元任务的准则,将复杂的操作轨迹划分为多个简单的元任务轨迹,极大地降低了微纳操作机器人的学习难度,适用微观环境下的机器人操作。According to the operating environment and motion characteristics of the micro-nano manipulating robot, the present invention establishes a criterion for dividing meta-tasks, and divides complex operation trajectories into a plurality of simple meta-task trajectories, which greatly reduces the learning difficulty of micro-nano manipulating robots, and is applicable to micro-manipulators. environment for robot operation.
本发明采用清晰度评价函数来计算微纳操作机器人末端执行器的深度运动时其清晰度的变化情况,来分析微纳操作机器人深度运动的移动情况,可以 区分运动和静止两种状态。The present invention uses the sharpness evaluation function to calculate the change of the sharpness of the end effector of the micro-nano manipulator robot during the deep motion, to analyze the movement of the micro-nano manipulator robot during the deep motion, and can distinguish between motion and static states.
本发明针对划分出来的同一个元任务的不同轨迹进行聚类,并对每一类轨迹进行编码学习,在不同的场景中使用不同的元任务轨迹可以更好地完成操作任务。The present invention clusters different trajectories of the same divided meta-task, and performs code learning for each type of trajectories, and uses different meta-task trajectories in different scenarios to better complete the operation task.
与传统的演示学习相比,本发明使用分割出来地简单的元任务轨迹作为示教,通过一系列优化过程得到最稳定的示教轨迹,进而采用DMP对这轨迹进行编码学习,极大地减小了DMP规划生成的轨迹与演示轨迹的误差。Compared with the traditional demonstration learning, the present invention uses the segmented simple meta-task trajectory as teaching, obtains the most stable teaching trajectory through a series of optimization processes, and then uses DMP to encode and learn this trajectory, greatly reducing The error between the trajectory generated by the DMP planning and the demonstration trajectory is minimized.
下面通过一个具体的实施例子来详细的阐述本发明提出的基于动态运动基元的微纳操作机器人自动拾取纳米线方法的内容。The content of the method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives proposed by the present invention will be described in detail below through a specific implementation example.
首先操作人员手动控制手柄完成拾取纳米线的任务,得到演示运动视频。对于从运动视频中截取的每一帧图像,存在许多噪声点,经对比验证选用低通高斯滤波处理,然后选择大小为1的圆形的核去腐蚀掉SEM图像中的纳米线。然后计算出图像中所有像素点的像素值,由于图像中背景占大部分区域,统计出最大占数比的像素值作为阈值,进行二值化分割,并识别出AFM悬臂梁和纳米线基底的轮廓,通过轮廓之间的区别可以识别出AFM悬臂梁的轮廓,以此可以计算出AFM悬臂梁的位置。通过识别连续帧图像中AFM悬臂梁的位置,根据图像帧的时间,可以获得微纳操作机器人XY平面的连续运动轨迹,如图4所示。First, the operator manually controls the handle to complete the task of picking up the nanowires, and obtains a demonstration motion video. For each frame of image intercepted from the motion video, there are many noise points. After comparison and verification, the low-pass Gaussian filter is used for processing, and then a circular nucleus with a size of 1 is selected to corrode the nanowires in the SEM image. Then calculate the pixel values of all pixels in the image. Since the background accounts for most of the area in the image, the pixel value with the largest ratio is counted as the threshold, and the binary segmentation is performed, and the AFM cantilever beam and the nanowire substrate are identified. Contour, the contour of the AFM cantilever can be identified by the difference between the contours, and the position of the AFM cantilever can be calculated. By identifying the position of the AFM cantilever beam in the continuous frame images, according to the time of the image frames, the continuous motion track of the XY plane of the micro-nano manipulator robot can be obtained, as shown in Figure 4.
然后根据定义的元任务的划分准则,将操作人员手动操纵拾取纳米线的演示轨迹进行分割:首先根据是否进行深度运动进行划分,可以发现在32s到252s这一时间段的XY轴轨迹基本不变,且抖动不超过15个像素点,且使用Teneggrad函数计算这段时间段的清晰度变化情况,然后使用多项式回归模型进行表征,得出其斜率为0.036,判定为此段时间为深度运动,将这一段分割出来,根据其运动特性命名为上升元任务,如图5所示。在上升元任务之前控 制悬臂梁运动到目标纳米线正下方,为上升元任务做基础,根据这种运动特性,本发明将这个运动命名为定位元任务,如图6所示。上升元任务之后,需要判断纳米线和AFM悬臂梁的接触状态。这个时候,从SEM收集到的二次电子图像看到的是纳米线和AFM悬臂梁的俯视图,它们之间是一个重叠状态,但是在Z轴方向上它们位置关系我们无法得知。因此可以增加悬臂梁在Y方向上的短距离摇摆的运动,通过该运动观察纳米线是否跟随悬臂梁移动来判断它们是一个怎样的接触状态,本发明将该运动定义为接触判断元任务,这是一个往返运动,轨迹也是特殊的,利用接触判断轨迹的特殊性从演示轨迹划分出来,如图6所示,一共划分出了3个接触判断元任务。而两个接触判断元任务之间就是接触修复元任务,根据这种时间上的特征分割出来,如图6所示。最后一次的接触判断的结果肯定是判定为线接触,这个时候肯定就是需要控制AFM悬臂梁将纳米线从基底上拔断,这个运动本发明定义为分离元任务,如图6所示。如此,本发明将一个完整的纳米线拾取任务演示划分为了六个简单的元任务,这样微纳操作机器人学习这六个元任务肯定比学习一个复杂的完整演示任务容易的多。Then, according to the division criterion of the defined meta-task, the demonstration trajectory of the operator manually picking up the nanowire is divided: firstly, it is divided according to whether the depth movement is performed, and it can be found that the XY axis trajectory during the period from 32s to 252s is basically unchanged , and the jitter does not exceed 15 pixels, and the Teneggrad function is used to calculate the sharpness change during this period, and then the polynomial regression model is used to characterize it, and the slope is 0.036, which is determined to be a deep movement during this period. This section is segmented out and named as rising meta-task according to its motion characteristics, as shown in Figure 5. Control the cantilever beam to move directly below the target nanowire before the ascending meta-task, which is the basis for the ascending meta-task. According to this motion characteristic, the present invention names this movement as the positioning meta-task, as shown in FIG. 6 . After the ascent meta task, it is necessary to judge the contact state of the nanowire and the AFM cantilever beam. At this time, the secondary electron image collected from the SEM shows the top view of the nanowire and the AFM cantilever beam. There is an overlapping state between them, but we cannot know their positional relationship in the Z-axis direction. Therefore, the short-distance swing motion of the cantilever beam in the Y direction can be increased. Through this motion, it is observed whether the nanowires follow the cantilever beam to move to judge what kind of contact state they are in. The present invention defines the motion as a contact judgment meta-task. It is a back-and-forth motion, and the trajectory is also special. Using the particularity of the contact judgment trajectory, it is divided from the demonstration trajectory. As shown in Figure 6, a total of three contact judgment meta-tasks are divided. Between the two contact judgment meta-tasks is the contact repair meta-task, which is divided according to this temporal feature, as shown in Figure 6. The result of the last contact judgment must be determined as wire contact. At this time, it is necessary to control the AFM cantilever beam to pull the nanowire from the substrate. This movement is defined as the separation element task in the present invention, as shown in FIG. 6 . In this way, the present invention divides a complete nanowire picking task demonstration into six simple meta-tasks, so that learning these six meta-tasks for the micro-nano manipulation robot is definitely much easier than learning a complex complete demonstration task.
最后元任务划分完毕之后,需要让微纳操作机器人学习这些元任务的运动技能,即对元任务进行编码,首先是对元任务轨迹进行滤波处理。因为SEM图像会受到多种因素干扰加上纳米操作机器人的抖动,计算出的AFM悬臂梁的移动轨迹会有许多小幅度抖动,采用滑动平均滤波器对运动轨迹进行过滤处理,其效果展示在图7中。划分出的同一类元任务轨迹之间的时间长度可能有差别,但是后续的处理需要时间长度一样的的轨迹,因此采用普氏动态时间规整PDTW进行轨迹对齐处理。对齐多个定位元任务轨迹效果如图8所示。然后使用GMM表征元任务的运动特性,并采用GMR泛化生成最稳定的元任务演示轨迹,如图9所示。最后使用DMP对GMR生成的最优演示轨迹进行编码,DMP不仅能够非常好地复现演示轨迹,同时能够泛化学习演示轨迹,在实际地轨迹规划时,起始点目标点有所变动也不会影响生成地轨迹,DMP复现定位元任务演 示轨迹的效果如图10所示。Finally, after the meta-tasks are divided, it is necessary to let the micro-nano manipulator robot learn the motor skills of these meta-tasks, that is, to encode the meta-tasks, and first to filter the meta-task trajectories. Because the SEM image will be disturbed by various factors and the jitter of the nano-manipulator robot, the calculated movement trajectory of the AFM cantilever beam will have many small jitters. The moving average filter is used to filter the movement trajectory. The effect is shown in Fig. 7 in. The time length between the divided task trajectories of the same class may be different, but subsequent processing requires trajectories with the same time length, so Platts Dynamic Time Warping (PDTW) is used for trajectory alignment processing. The effect of aligning multiple positioning meta-task trajectories is shown in Figure 8. Then GMM is used to characterize the motion properties of the meta-task, and GMR generalization is adopted to generate the most stable meta-task demonstration trajectory, as shown in Fig. 9. Finally, DMP is used to encode the optimal demonstration trajectory generated by GMR. DMP can not only reproduce the demonstration trajectory very well, but also can generalize the learning demonstration trajectory. In the actual trajectory planning, the starting point and the target point will not change. Affecting the generated trajectory, the effect of DMP reproducing the positioning meta-task demonstration trajectory is shown in Figure 10.
相应于上面的方法实施例,本发明实施例还提供了一种计算机设备,包括:Corresponding to the above method embodiment, the embodiment of the present invention also provides a computer device, including:
存储器,其用于存储计算机程序;memory for storing computer programs;
处理器,其用于执行计算机程序时实现上述基于动态运动基元的微纳操作机器人自动拾取纳米线方法的步骤。A processor, which is used to implement the steps of the above-mentioned method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives when executing a computer program.
在本发明实施例中,处理器可以为中央处理器(Central Processing Unit,CPU)、特定应用集成电路、数字信号处理器、现场可编程门阵列或者其他可编程逻辑器件等。In the embodiment of the present invention, the processor may be a central processing unit (Central Processing Unit, CPU), an application-specific integrated circuit, a digital signal processor, a field programmable gate array, or other programmable logic devices.
处理器可以调用存储器中存储的程序,具体的,处理器可以执行基于动态运动基元的微纳操作机器人自动拾取纳米线方法的实施例中的操作。The processor can call the program stored in the memory. Specifically, the processor can execute the operations in the embodiment of the method for automatically picking up nanowires by a micro-nano manipulation robot based on dynamic motion primitives.
存储器中用于存放一个或者一个以上程序,程序可以包括程序代码,程序代码包括计算机操作指令。The memory is used to store one or more programs, the programs may include program codes, and the program codes include computer operation instructions.
此外,存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件或其他易失性固态存储器件。In addition, the memory may include high-speed random access memory, and may also include non-volatile memory, such as at least one magnetic disk storage device or other volatile solid-state storage devices.
相应于上面的方法实施例,本发明实施例还提供了一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现上述基于动态运动基元的微纳操作机器人自动拾取纳米线方法的步骤。Corresponding to the above method embodiment, the embodiment of the present invention also provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the above-mentioned dynamic motion primitive-based micro Steps in the method for automatically picking up nanowires by a nanomanipulator robot.
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘 存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。Those skilled in the art should understand that the embodiments of the present application may be provided as methods, systems, or computer program products. Accordingly, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present application may take the form of a computer program product embodied on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。The present application is described with reference to flowcharts and/or block diagrams of methods, apparatus (systems), and computer program products according to embodiments of the present application. It should be understood that each procedure and/or block in the flowchart and/or block diagram, and a combination of procedures and/or blocks in the flowchart and/or block diagram can be realized by computer program instructions. These computer program instructions may be provided to a general purpose computer, special purpose computer, embedded processor, or processor of other programmable data processing equipment to produce a machine such that the instructions executed by the processor of the computer or other programmable data processing equipment produce a An apparatus for realizing the functions specified in one or more procedures of the flowchart and/or one or more blocks of the block diagram.
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing apparatus to operate in a specific manner, such that the instructions stored in the computer-readable memory produce an article of manufacture comprising instruction means, the instructions The device realizes the function specified in one or more procedures of the flowchart and/or one or more blocks of the block diagram.
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。These computer program instructions can also be loaded onto a computer or other programmable data processing device, causing a series of operational steps to be performed on the computer or other programmable device to produce a computer-implemented process, thereby The instructions provide steps for implementing the functions specified in the flow chart or blocks of the flowchart and/or the block or blocks of the block diagrams.
显然,上述实施例仅仅是为清楚地说明所作的举例,并非对实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引申出的显而易见的变化或变动仍处于本发明创造的保护范围之中。Apparently, the above-mentioned embodiments are only examples for clear description, and are not intended to limit the implementation. For those of ordinary skill in the art, on the basis of the above description, other changes or changes in various forms can also be made. It is not necessary and impossible to exhaustively list all the implementation manners here. However, the obvious changes or changes derived therefrom are still within the scope of protection of the present invention.

Claims (10)

  1. 一种基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于,包括以下步骤:A method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives, characterized in that it includes the following steps:
    S10:获取操作人员操作微纳操作机器人完成纳米线拾取任务的演示轨迹;S10: Obtain the demonstration track of the operator operating the micro-nano operation robot to complete the nanowire picking task;
    S20:利用评价函数判断所述微纳操作机器人的演示轨迹上是否有深度运动信息,若判断结果为是,则该段轨迹为深度运动,若判断结果为否,则该段轨迹为平面运动,并将所述微纳操作机器人的演示轨迹划分为多个简单的元任务,其中元任务的划分准则为根据是否进行深度运动进行划分;S20: Using the evaluation function to judge whether there is depth motion information on the demo trajectory of the micro-nano manipulator robot, if the judgment result is yes, then this section of trajectory is a depth movement, if the judgment result is no, then this section of trajectory is a planar movement, And the demonstration trajectory of the micro-nano manipulator is divided into a plurality of simple meta-tasks, wherein the division criterion of the meta-tasks is divided according to whether to carry out deep motion;
    S30:对元任务进行编码并建立元任务库,在有纳米线自动拾取任务时,所述微纳操作机器人调用所述元任务库中的元任务,按照所述元任务的轨迹进行运动,完成纳米线自动拾取任务。S30: Encode the meta-task and establish a meta-task library. When there is a nanowire automatic picking task, the micro-nano operation robot calls the meta-task in the meta-task library, moves according to the trajectory of the meta-task, and completes Nanowire automatic pickup tasks.
  2. 根据权利要求1所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于,在S10中,获取微纳操作机器人的演示轨迹包括:The method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives according to claim 1, wherein, in S10, obtaining the demonstration trajectory of the micro-nano operating robot includes:
    获取微纳操作机器人的运动视频,在所述运动视频上截取多帧图像;Obtaining the movement video of the micro-nano operation robot, and intercepting multiple frames of images on the movement video;
    选用低通高斯滤波器对每一帧图像进行滤波处理,并对滤波处理后的图像先后进行腐蚀和二值化处理,获得所述图像中的悬臂梁和纳米线的轮廓。A low-pass Gaussian filter is selected to filter each frame of image, and the filtered image is etched and binarized successively to obtain the outlines of the cantilever beam and the nanowire in the image.
  3. 根据权利要求2所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于,在S20中,利用评价函数判断所述微纳操作机器人的演示轨迹上是否有深度运动信息包括:The method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives according to claim 2, wherein in S20, an evaluation function is used to judge whether there is depth motion information on the demonstration track of the micro-nano manipulating robot include:
    将Tenengrad梯度函数作为评价函数,利用Tenengrad梯度函数计算悬臂梁在静止不动和进行深度运动时各自的清晰度变化情况,使用多项式回归 模型进行表征,得出对应的斜率,判断悬臂梁是否进行深度运动还是静止不动。The Tenengrad gradient function is used as the evaluation function, and the Tenengrad gradient function is used to calculate the sharpness changes of the cantilever beam when it is stationary and in depth motion, and the polynomial regression model is used for characterization, and the corresponding slope is obtained to judge whether the cantilever beam is in depth. Motion or stillness.
  4. 根据权利要求3所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于,在S20中,将所述微纳操作机器人的演示轨迹划分为多个简单的元任务,其中元任务的划分准则为根据是否进行深度运动进行划分包括:The method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives according to claim 3, wherein in S20, the demonstration trajectory of the micro-nano operating robot is divided into a plurality of simple meta-tasks, Among them, the division criteria of meta-tasks are divided according to whether to carry out in-depth motion, including:
    将所述演示轨迹上进行深度运动的一段轨迹分割出来,将该运动定义为上升元任务,在执行上升元任务之前,将悬臂梁运动到纳米线正下方,将该运动定义为定位元任务;Segmenting a segment of the track for deep motion on the demo track, defining the motion as an ascending element task, before performing the ascending element task, moving the cantilever beam directly below the nanowire, and defining the motion as a positioning element task;
    控制所述悬臂梁上升后增加悬臂梁在Y方向上的短距离摇摆的运动,并将该运动定义为接触判断元任务,根据所述接触判断元任务判断所述悬臂梁和纳米线的接触状态,若所述悬臂梁和纳米线的接触状态为线接触,则控制悬臂梁将纳米线拾取,并将该运动定义为分离元任务,若所述悬臂梁和纳米线的接触状态为点接触,则定义接触修复元任务对点接触进行修复,直至悬臂梁和纳米线的接触状态为线接触。After controlling the rise of the cantilever beam, increasing the short-distance swing motion of the cantilever beam in the Y direction, and defining this motion as a contact judgment meta-task, judging the contact state between the cantilever beam and the nanowire according to the contact judgment meta-task , if the contact state of the cantilever beam and the nanowire is line contact, then control the cantilever beam to pick up the nanowire, and define this motion as a separation element task, if the contact state of the cantilever beam and the nanowire is point contact, Then define the contact repair meta-task to repair the point contact until the contact state between the cantilever beam and the nanowire is line contact.
  5. 根据权利要求4所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于:所述接触修复元任务为至少一个。The method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives according to claim 4, wherein there is at least one contact repair element task.
  6. 根据权利要求1所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于,在S30中,对元任务进行编码包括:The method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives according to claim 1, wherein in S30, encoding the meta-task includes:
    对所述元任务的轨迹进行滤波处理,并采用普氏动态时间规整对滤波处理后的元任务的轨迹进行轨迹对齐处理,将多个轨迹正则化到同一时间步长;The trajectory of the meta-task is filtered, and Platts dynamic time warping is used to perform trajectory alignment processing on the trajectory of the filtered meta-task, and multiple trajectories are normalized to the same time step;
    采用高斯混合模型表征轨迹对齐处理后的元任务的运动特性,并采用混合高斯回归泛化生成元任务演示轨迹;A Gaussian mixture model is used to characterize the motion characteristics of the meta-task after trajectory alignment processing, and a mixture of Gaussian regression generalization is used to generate a meta-task demonstration trajectory;
    使用动态运动基元对元任务演示轨迹进行编码处理。Meta-task demonstration trajectories are encoded using dynamic motion primitives.
  7. 根据权利要求6所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于:所述元任务包括划分的元任务和引入的空走演示元任务。The method for automatically picking up nanowires by a micro-nano manipulating robot based on dynamic motion primitives according to claim 6, wherein the meta-tasks include divided meta-tasks and introduced empty-walk demonstration meta-tasks.
  8. 根据权利要求6所述的基于动态运动基元的微纳操作机器人自动拾取纳米线方法,其特征在于:所述普氏动态时间规整的公式如下:The method for automatically picking up nanowires by a micro-nano operating robot based on dynamic motion primitives according to claim 6, wherein the formula of Platts dynamic time warping is as follows:
    Figure PCTCN2022078316-appb-100001
    Figure PCTCN2022078316-appb-100001
    其中,
    Figure PCTCN2022078316-appb-100002
    为第i个需要对齐的轨迹,i=1,2,…,m,
    Figure PCTCN2022078316-appb-100003
    是时间正则化矩阵。
    in,
    Figure PCTCN2022078316-appb-100002
    is the i-th track to be aligned, i=1,2,...,m,
    Figure PCTCN2022078316-appb-100003
    is the time regularization matrix.
  9. 一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现权利要求1至8任一项所述方法的步骤。A computer device, comprising a memory, a processor, and a computer program stored on the memory and operable on the processor, characterized in that, when the processor executes the program, it realizes any one of claims 1 to 8 method steps.
  10. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1至8任一项所述方法的步骤。A computer-readable storage medium, on which a computer program is stored, wherein the program implements the steps of the method according to any one of claims 1 to 8 when the program is executed by a processor.
PCT/CN2022/078316 2022-01-27 2022-02-28 Method for automatically picking up nanowires by micro-nano operation robot on basis of dynamic motion primitives WO2023142215A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202210102719.0 2022-01-27
CN202210102719.0A CN114549269A (en) 2022-01-27 2022-01-27 Method for automatically picking up nano-wire by micro-nano operation robot based on dynamic motion primitive

Publications (1)

Publication Number Publication Date
WO2023142215A1 true WO2023142215A1 (en) 2023-08-03

Family

ID=81673714

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/078316 WO2023142215A1 (en) 2022-01-27 2022-02-28 Method for automatically picking up nanowires by micro-nano operation robot on basis of dynamic motion primitives

Country Status (2)

Country Link
CN (1) CN114549269A (en)
WO (1) WO2023142215A1 (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9764469B1 (en) * 2013-12-13 2017-09-19 University Of South Florida Generating robotic trajectories with motion harmonics
CN110561450A (en) * 2019-08-30 2019-12-13 哈尔滨工业大学(深圳) Robot assembly offline example learning system and method based on dynamic capture
CN110561430A (en) * 2019-08-30 2019-12-13 哈尔滨工业大学(深圳) robot assembly track optimization method and device for offline example learning
CN110653824A (en) * 2019-07-26 2020-01-07 同济人工智能研究院(苏州)有限公司 Method for characterizing and generalizing discrete trajectory of robot based on probability model
CN110900609A (en) * 2019-12-11 2020-03-24 浙江钱江机器人有限公司 Robot teaching device and method thereof
CN111890353A (en) * 2020-06-24 2020-11-06 深圳市越疆科技有限公司 Robot teaching track reproduction method and device and computer readable storage medium
CN113043251A (en) * 2021-04-23 2021-06-29 江苏理工学院 Robot teaching reproduction track learning method
EP3898132A1 (en) * 2019-02-01 2021-10-27 Google LLC Generating a robot control policy from demonstrations

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015058297A1 (en) * 2013-10-25 2015-04-30 Vakanski Aleksandar Image-based trajectory robot programming planning approach
CN105500389A (en) * 2016-02-03 2016-04-20 苏州大学 Automatic replacement device of end effector of micro-nano robot
WO2018022718A1 (en) * 2016-07-26 2018-02-01 University Of Connecticut Skill transfer from a person to a robot

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9764469B1 (en) * 2013-12-13 2017-09-19 University Of South Florida Generating robotic trajectories with motion harmonics
EP3898132A1 (en) * 2019-02-01 2021-10-27 Google LLC Generating a robot control policy from demonstrations
CN110653824A (en) * 2019-07-26 2020-01-07 同济人工智能研究院(苏州)有限公司 Method for characterizing and generalizing discrete trajectory of robot based on probability model
CN110561450A (en) * 2019-08-30 2019-12-13 哈尔滨工业大学(深圳) Robot assembly offline example learning system and method based on dynamic capture
CN110561430A (en) * 2019-08-30 2019-12-13 哈尔滨工业大学(深圳) robot assembly track optimization method and device for offline example learning
CN110900609A (en) * 2019-12-11 2020-03-24 浙江钱江机器人有限公司 Robot teaching device and method thereof
CN111890353A (en) * 2020-06-24 2020-11-06 深圳市越疆科技有限公司 Robot teaching track reproduction method and device and computer readable storage medium
CN113043251A (en) * 2021-04-23 2021-06-29 江苏理工学院 Robot teaching reproduction track learning method

Also Published As

Publication number Publication date
CN114549269A (en) 2022-05-27

Similar Documents

Publication Publication Date Title
EP3742347B1 (en) Deep machine learning methods and apparatus for robotic grasping
Sievers et al. Real-time object tracking for the robot-based nanohandling in a scanning electron microscope
CN107146237B (en) Target tracking method based on online state learning and estimation
CN111127519B (en) Dual-model fusion target tracking control system and method thereof
Husain et al. Realtime tracking and grasping of a moving object from range video
Liu et al. Automated robotic measurement of 3-D cell morphologies
CN111445497B (en) Target tracking and following method based on scale context regression
CN113119108B (en) Grabbing method, system and device of two-finger mechanical arm and storage medium
Zhang et al. Industrial robot sorting system for municipal solid waste
Gong et al. Tracking and grasping of moving target based on accelerated geometric particle filter on colored image
CN109493370B (en) Target tracking method based on space offset learning
WO2023142215A1 (en) Method for automatically picking up nanowires by micro-nano operation robot on basis of dynamic motion primitives
CN113362358A (en) Robust pose estimation method based on instance segmentation in dynamic scene
Pajarinen et al. POMDP planning under object composition uncertainty: Application to robotic manipulation
CN114571458B (en) Micro-nano robot assembly track learning method based on dynamic motion elements
Hossain et al. Object recognition and robot grasping: A deep learning based approach
CN108469729B (en) Human body target identification and following method based on RGB-D information
WO2023245708A1 (en) Machine vision-based electrode implantation method and system
US20170076909A1 (en) System and method for providing real-time visual feedback to control multiple autonomous nano-robots
Lin et al. Inference of 6-DOF robot grasps using point cloud data
Timmermann et al. A hybrid approach for object localization combining mask R-CNN and Halcon in an assembly scenario
Liang et al. Atomic force microscope tip localization and tracking through deep learning based vision inside an electron microscope
Ru et al. An improved visual tracking method in scanning electron microscope
Ogas et al. Object grasping with a robot arm using a convolutional network
Liu et al. Locating end-effector tips in automated micromanipulation

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22923036

Country of ref document: EP

Kind code of ref document: A1