- 1School of Electrical Engineering and Automation, Xiamen University of Technology, Xiamen, China
- 2Fujian Provincial Key Laboratory of Information Processing and Intelligent Control, Minjiang University, Fuzhou, China
In recent years, research on the manipulation and control of microrobot has gradually matured. In order to improve the intelligence of microrobots, navigation study also becomes an important research topic. In practice, microrobots could be disturbed by the flowing liquid when it moves in a microfluidic environment. As a result, the actual trajectory of microrobots will deviate from the intended one. In this paper, firstly, different algorithms for the navigation of microrobots in a simulated plant leaf vein environment are investigated. According to the simulation results, RRT*-Connect is then selected as the path planning algorithm with a relatively better performance. Based on the pre-planned trajectory, a fuzzy PID controller is further designed for precise trajectory tracking, which can effectively eliminate the random disturbance caused by micro-fluid flow during the motion and make it quickly recover to a stable movement state.
1 Introduction
Relative to the development of microrobotic-driven technology, a big number of researchers have investigated its application in biomedical therapies, including targeted drug delivery, vascular navigation, biomarkers, and cell delivery (Arcese et al., 2010; Ju et al., 2014; Kim and Ishiyama, 2014; Liu et al., 2017; Fan et al., 2018). Li et al. (2010) proposed a novel artificial hair receptor prototype for a hopping minirobot sensing system with a high aspect ratio of aligned polyvinylidine (PVDF) micro/nanofiber arrays. It also proves the feasibility of the thermal direct fiber stretching technology on PVDF materials and the application prospect of the produced fibers as a micro/micro-biological robot sensing system. The reliable response and the good sensitivity of micro/nano PVDF fibers to pressure changes and various flows were verified. It shows that artificial hair cell receptors are very promising for wind properties and environmental vibration detection, which are essential for jumping microrobot sensing systems. Chen et al. (2020) designed a magnetically driven thumb-shaped and disc-like bilayer (chitosan and calcium alginate hydrogel) drug-loaded mini-robot with high mobility and motion precision. It has advanced mobility, pH sensitivity, and sustained drug release capability. The results of this work pave the way for targeted therapy for intestinal cancer after oral drug administration.
The microfluidic environment in human or plants could be complex for the manipulation of microrobot. To achieve the autonomous navigation movement of microrobots, the manipulation process should be combined with rapid path planning algorithm. Meng et al. (2019) used width-first search and genetic algorithms to generate robotic navigation reference tracks and proposed a navigation controller combined with slide control, backward control, and perturbation compensation to realize the targeted transport of tumor drugs in mouse liver blood vessels. Liu et al. (2020) applied Informed-RRT* for path planning for the spiral micro-swimming robot in a chaotic environment. Kinematical and nonintegrity constraint of the spiral micro-swimming robot are proposed, which ensure the reliability of obstacle avoidance. However, in a complex and narrow environment, such as the veins of the eyeball or the brain or the complex vein environment of plant leaves, Informed-RRT* will fall into a local optimal state, which is not reliable for path searching. Therefore, a fast, effective, asymptotically optimal stochastic path planning algorithm should be introduced. As a high-configuration algorithm, the simple and effective RRT-Connect algorithm requires no adjustment for parameters, which has interactive performance for most situations and improves the speed of tree generation for RRT (Kuffner and LaValle, 2000). Moreover, improvement for the collision-free optimization is further studied. Klemm et al. (2015) combined the ability of RRT-Connect with the best solution of RRT* in order to quickly find a path even in complex environments, which is called the RRT*-Connect algorithm. This method was proven to be successfully faster than normal RRT* and also provided the best solution for convergence.
In addition to route navigation, accurate tracking of trajectory is also an important aspect for microrobot manipulation research (Huan et al., 2022). In order to conduct the application of microrobot to in vivo targeted therapy, the external contactless electromagnetically driven system requires a precise controller combined with appropriate control algorithm. Meanwhile, it should be ensured that the actual trajectory of microrobot is appropriate and less drift appeared during the process of movement in the microfluidic environment. Khalil et al. (2014) provided a stable magnetic field and disturbance observation with a double-loop controller, which realized the magnetic flow map construction and point-to-point orientation for the paramagnetic particles. Yang et al. (2018) combined the dynamic model of the microrobot with external perturbations. The motion state of the microrobot was estimated with an extended state observer. Generalized perturbations were compensated as well. Then, a linear trajectory tracking controller was designed based on the estimated motion state to realize the precise manipulation for the microrobot.
In this paper, RRT*-Connect algorithm is introduced for the navigation of a microrobot in a plant vein mimic environment. Based on the planned path, a fuzzy PID controller for trajectory tracking is proposed for precise manipulation in an actual microfluidic environment. Simulation for real-time path planning and trajectory tracking control were conducted in combination with the electromagnetically driven system. The results show that the proposed algorithm and controller can achieve accurate navigation and control for the microrobot manipulation in a branching microenvironment mimicking the plant vein.
2 Methods
2.1 Force analysis of magnetic drive microrobot
In our experiment, Fe3O4 magnetic beads coated with soluble gel were used as microrobots with a diameter of 20 μm. The kinetic analysis for the magnetic microrobot in a microfluidic environment is shown in Figure 1A. As soon as the magnetic coils are energized, a gradient magnetic field could be generated in the workspace (Liu et al., 2017; Fan et al., 2022). The induced magnetic force on the microrobot could be given as (1):
Figure 1 Force analysis and motion trajectory of a microrobot in a microfluidic environment. (A) Force analysis of a microrobot. (B) Motion trajectory. (C) Diagram of RRT*-Connect algorithm. (D) Photo of a real plant vein. (E) Simulation environment distribution in two conditions. (F) Fuzzy PID control diagram.
where Fm is the magnetic force generated by the gradient magnetic field, M is the magnetic field strength, ∇B is the magnetic field gradient, and R is the radius of the microrobot. Fd is the viscous resistance of microfluid, η is the fluid viscosity coefficient, v is the motion velocity of the robot, and vr is the velocity of the microfluid. G is the robot’s own gravity, and Ff is the buoyancy of the microrobot.
In order to facilitate the control of the magnetic beads in the fluid environment, the density of the solution is adjusted to be the same as the microrobot. Thus, the gravity and the buoyancy of the microrobot could be ignored. Therefore, the dynamic model of the microrobot in the microfluidic environment is simplified as follows:
where Δ is the random perturbation in the microfluidic environment.
2.2 Navigation and control system design
The flow resistance in the microfluidic environment mainly depends on the radius of the channel and the viscosity coefficient of the fluid, which varies according to the distance to the wall of the micro-channel (Liang et al., 2011). As we can see, at the branch of the plant vein mimic map, the direction of the microfluid flow changes due to the reduction of the leaf vein caliber; therefore, the viscous resistance on the microrobot will also change accordingly. Perturbations could also be generated to enforce the microrobot deviating from the desired trajectory, as shown in Figure 1B.
2.2.1 Navigation of microrobot
It has been studied that RRT* algorithm is able to find an initial path quickly. It could be optimized continuously with increasing sampling point within the maximum number of cycles. However, the RRT* algorithm is asymptotically optimized. If a satisfactory path is expected, the time of RRT* algorithm needs to be further optimized. Informed-RRT* algorithm is a sampling optimization process based on the RRT* algorithm, utilizing elliptical sampling instead of global uniform sampling to significantly improve the path search speed. Nevertheless, Informed-RRT* algorithm is prone to fall into local optimum in a relatively narrow environment channel and fail to find a satisfied route. In contrast, RRT*-Connect is able to simultaneously grow two fast random trees for state space search which could improve the path search efficiency. As shown in Figure 1C, the start point in the figure is displayed in green, while the end point is displayed in red. During navigation simulation, RRT*-Connect algorithm generates two trees from both start point and end point. It connects the nearest nodes randomly picked from the environment map. For different complexities of various environments, the step size parameter of RRT*-Connect algorithm could be adjusted according to the obtained simulation results. If the time spent for the search process is too long, the step size needs to be increased. On the contrary, if the results are available immediately, the step size could be decreased to get a more optimized path. The maximum step for the search process is denoted by disTh in the RRT*-Connect algorithm. Moreover, the value of disTh could be set flexibly so that all the nodes whose distance is less than disTh are regarded as the same node.
Figure 1D shows a real photo of the plant vein which contains lots of branching structures. The simulated map was constructed accordingly. Since the characteristic for different parts of the plant vein mimic map varied, different areas of the map were chosen for the path planning simulation. One series is chosen to be short distance between the start point and end point in different locations (namely, A1, A2, and A3, respectively, for a short distance with a relatively wide, narrow, and narrowest channel) of the vein mimic channel. Another situation is chosen to be a larger distance between the start point and the end point with a different channel width for planning simulation (namely B1, B2, and B3, respectively, for a long distance with a relatively wide, narrow, and narrowest channel), as shown in Figure 1E. The width of the channel in the plant vein mimic map gets smaller from the beginning to the end. Afterwards, we compared the searching efficiency with four different algorithms—RRT*-Connect, RRT*, PRM, and Informed-RRT*—in different situations and analyzed the time required for the search process.
2.2.2 Design of fuzzy PID controller
PID is one of the most common algorithms in the field of robot control. The dynamic process could be set faster, smoother, and to be more accurate through the regulation of proportional (P), integral (I), and differential (D). The traditional PID controller is well adapted and has strong robustness. It is a simple algorithm whose control parameter is relatively independent from each other. However, during the trajectory tracking for microrobot manipulation, undesired overshoot could be generated due to the perturbations caused by a variety of microfluidic velocity. In addition, the parameters of the PID controller cannot be adjusted once they are determined. Fuzzy PID controller has been studied widely in the past few decades. It combines the characteristics of a flexible and adaptable fuzzy controller and a highly accurate PID controller. Therefore, this paper adopts a fuzzy PID controller for the manipulation of a microrobot in the plant vein mimic environment, which could make up for the lack of integration link in simple fuzzy controller and solve the problem of fixed parameters in the traditional PID control method.
According to the trajectory tracking model of microrobot manipulation, the proposed fuzzy controller has two inputs and three outputs. One of the inputs is the displacement error e between the actual output movement and the desired trajectory of the microrobot. The other input is the rate of displacement error, given as ec. The parameters for a PID controller could be adjusted promptly with a fuzzy controller, which makes the trajectory tracking of a microrobot more accurate. The diagram of the fuzzy PID controller is shown in Figure 1F.
where kp0, ki0, and kd0 are the initial values of the PID controller, y0 is the desired trajectory of the microrobot in the microenvironment, y1 is the actual output trajectory, e is the offset error of the robot trajectory, and ec is the variation rate of the displacement error. Δkp,Δki, and and Δkd are the adjustment parameters of the PID controller as well as the output variables of the fuzzy controller. Figure 2 illustrates the code architecture of the entire integrated navigation and control system. The desired trajectory could be generated with an optimized path planning algorithm. Then, the microrobot was manipulated under the proposed control strategy tracking the preplanned trajectory. During the manipulation, the real position of the microrobot could be detected through image processing. The current input of the experimental setup should be determined by the control system. Thus, a microrobot could be automatically driven to track the preplanned trajectory to the target position.
3 Results and discussion
3.1 Navigation simulation
In this paper, a plant vein mimic map with a size of 662*612 pixels was constructed. The positions of the start points and the end points for two series of situations mentioned above were pre-set respectively, A1 [start point (345,491), end point (341,406)], A2 [start point (281, 448), end point (217, 381)], A3 [start point (384, 362), end point (419, 332)], B1 [start point (349, 451), end point (371, 224)], B2 [start point (299, 464), end point (183, 399)], and B3 [start point (351, 523), end point (480, 385)]. Each of the two series has a different width of channel for microrobot movement. The basic RRT* algorithm is random, whose search result could be different for the same situation. The average search time used for different algorithms was compared with each other.
As shown in Figure 3, the simulation results for the path planning process in the environment described in Figure 1D are proposed. The width of the channels gradually decreased as shown in both Figures 3A–C and Figures 3E–G. According to the simulation results, three kinds of algorithms could smoothly finish the path searching process, either in the relatively wide or narrow channels. As shown in Figures 3D, H, data on the time consumption of RRT*, PRM, and RRT*-Connect were collected and compared. It can be seen from the chart that the search speed of RRT*-Connect is relatively faster with a higher success rate compared with other algorithms. Meanwhile, the time consumption of RRT*-Connect is relatively stable in several simulation experiments, which is always the least among the proposed algorithms. This indicates that the RRT*-Connect algorithm could be able to plan a path in a complex environment, with stable probability and fast processing speed. The adaptation ability of the RRT* algorithm was proven to be strong in navigation research, but failure would also appear in some processes of the simulation experiments. PRM is based on the global sampling probability whose time consumption is relatively larger than the other two. Furthermore, when used in situation A3 with the narrowest passage as well as in situation B2 with a relatively narrower channel and a larger traveling distance, the time consumption and failure rate would increase. Informed-RRT* algorithm has also been utilized for navigation in the plant vein mimic map, which was used in our previous research (Huan et al., 2022). This algorithm shrinks the sampling space into an oval area based on a feasible path obtained by RRT*. However, as the microrobot moved into the narrow channel of the map, the Informed-RRT* algorithm would fall into a locally optimal solution. Thus, in most of the times in our simulation experiments, Informed-RRT* failed to find a suitable route in a limited time. By comparing the results of the simulation of the RRT*, PRM, and RRT*-Connect algorithms, it can be concluded that the RRT*-Connect algorithm is highly adaptable and the most stable among the proposed algorithms.
Figure 3 Simulation of road strength planning in case 1: (A) A1 environment, (B) A2 environment, (C) A3 environment, (D) B1 environment, (E) B2 environment, and (F) B3 environment. (G) Time consumed by path search in case 1. (H) Time consumed by path search in case 2.
3.2 Trajectory tracking analysis
In practice, the movement of a microrobot would be affected by the disturbance of the microfluidic environment factor, which leads the actual trajectory to deviate from the desired trajectory. Therefore, a suitable controller should be introduced to adjust the actual error of the trajectory as close to the preplanned trajectory as possible in the plant vein mimic map. To make the process more reliable, the environment B2 with vein branches and a long distance between the start and end points was tested. Tracking simulation experiments were conducted both with and without step disturbances. Moreover, the trajectory tracking error was analyzed, as shown in Figure 4. The red line in the figure indicates the control curve of the fuzzy PID controller, while the blue line stands for the traditional PID controller with proper parameters. As illustrated in Figures 4A, B, the PID controller and the fuzzy PID controller have a similar capability to keep the desired trajectory for microrobot manipulation with a small tracking error. According to the tracking curve, the response speed of the PID controller and the fuzzy PID controller at a certain time could be different after a step signal disturbance was introduced. As proposed in Figure 4C, the control performance with step disturbance was analyzed. The peak value and overshoot of the fuzzy PID controller are a bit less than those of the traditional PID controller. Thus, the control effect of the fuzzy PID is relatively better than the PID controller.
Figure 4 Trajectory tracking error of the PID controller (blue curve) and the fuzzy PID controller (red curve). (A) Tracking error without disturbance. (B) Tracking error with step signal disturbance. (C) Control performance analysis with step disturbance.
In the microfluidic environment, the movement microrobot is mainly influenced by the flow velocity. The viscous resistance increased as the microrobot moved closer to the channel wall. That is to say, flow velocity varied in different positions of the flow channel. Thus, step signal disturbance cannot simulate the real environment exactly. A sinusoidal periodic signal, as given in Eq. 9, was added to the system as the disturbance for further processing:
With the proposed sinusoidal periodic disturbance, the tracking error curves and the tracking performance of the PID controller and the fuzzy PID controller were performed, as shown in Figure 5. According to the tracking error curves in Figure 5A, both the PID controller and the fuzzy PID controller have a good anti-interference ability in the trajectory tracking process. However, the steady-state error of the fuzzy PID controller is less than that of the PID controller. As shown in Figure 5B, compared with the PID controller, the system overshoot of the fuzzy PID controller is also smaller than that of the PID controller, which indicates a better controller performance. The mean squared tracking errors for two series of situations are illustrated in Table 1 under the two different control methods. In conclusion, the proposed fuzzy PID controller can realize the secondary regulation for the system on the basis of improving the accuracy of the traditional PID controller. The disturbance caused by the microfluidics could be adjusted effectively.
Figure 5 Analysis of the simulation results: (A) error curve and (B) performance analysis of tracking curve.
4 Conclusion
In this paper, an integrated navigation and control system for a microrobot was proposed. A dynamic model of a microrobot was analyzed within the microfluidic environment. The desired trajectory of the microrobot was planned through the RRT*-Connect algorithm, which has a better performance than other similar algorithms. In order to further improve the driven accuracy for manipulating a microrobot to move along the desired trajectory, a fuzzy PID controller was introduced. Based on the online parameter adjustment of the PID controller with a fuzzy module, the trajectory tracking error for a microrobot could be reduced, and the actual movement is much closer to the desired trajectory. The simulation results show that the proposed integrated system can significantly improve the anti-interference ability and track the tracking accuracy of microrobots in a microfluidic environment mimicking the plant vein. It lays the foundation for further promoting the plant/organism application of microrobots. The microrobots manipulated in the plant vein could be used as microsensors to study the dynamics of plants under photosynthesis. In addition, the bio-microsensors could monitor the health of the plant in real time.
Data availability statement
The original contributions presented in the study are included in the article/supplementary material. Further inquiries can be directed to the corresponding author.
Author contributions
ZH, JW, and WM: conceptualization, methodology, validation, data analysis, and writing—original draft preparation. LZ, ZZ, and ZC: material development and writing—review and editing. All authors contributed to the article and approved the submitted version.
Funding
This work was supported by the National Natural Science Foundation of China under grant number 61903315 and the Natural Science Foundation of Fujian Province under grant number 2020J01285.
Conflict of interest
The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.
Publisher’s note
All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article, or claim that may be made by its manufacturer, is not guaranteed or endorsed by the publisher.
References
Arcese, L., Cherry, A., Fruchard, M., Ferreira, A. (2010). “High gain observer for backstepping control of a MRI-guided therapeutic microrobot in blood vessels,” in IEEE RAS & EMBS International Conference on Biomedical Robotics and Biomechatronics, Tokyo, Japan. 349–354 (IEEE). doi: 10.1109/BIOROB.2010.5627806
Chen, W. ,. N., Sun, M., Fan, X., J and Xie, H. (2020). Magnetic/PH-sensitive double-layer microrobots for drug delivery and sustained release. Appl. Materials Today 100583 (19). doi: 10.1016/j.apmt.2020.100583
Fan, Q., Cui, G., Zhao, Z., Shen, J. (2022). Obstacle avoidance for microrobots in simulated vascular environment based on combined path planning. IEEE Robotics Automation Lett. 7 (4), 9794–9801. doi: 10.1109/LRA.2022.3191540
Fan, X., Sun, M., Lin, Z., Song, J., He, Q., Sun, L. (2018). Automated noncontact micromanipulation using magnetic swimming microrobots. IEEE Nanotech. 17 (4), 666–669. doi: 10.1109/TNANO.2018.2797325
Huan, Z., Ma, W., Wang, J., Wu, F. (2022). Path planning and optimization for micro-robot in a vessel-mimic environment. Front. IN NEUROROBOTICS 16, 923348. doi: 10.3389/fnbot.2022.923348
Ju, T., Liu, S., Yang, J., Sun, D. (2014). Rapidly exploring random tree algorithm-based path planning for robot-aided optical manipulation of biological cells. IEEE Trans. Automation Sci. Eng. 11 (3), 649–657. doi: 10.1109/TASE.2013.2289311
Khalil, I., Abelmann, L., Misra, S. (2014). Magnetic-based motion control of paramagnetic microparticles with disturbance compensation. IEEE Trans. Magnetics 50 (40), 1–10. doi: 10.1109/TMAG.2014.2323940
Kim, S. H., Ishiyama, K. (2014). Magnetic robot and manipulation for active-locomotion with targeted drug release. IEEE/ASME Trans. Mechatronics 19 (5), 1651–1659. doi: 10.1109/TMECH.2013.2292595
Klemm, S., Oberlander, J., Hermann, A., Roennau, A., Schamm, T., Zollner, J, et al. (2015). “RRT-connect: Faster, asymptotically optimal motion planning,” in 2015 IEEE International Conference on Robotics and Biomimetics (ROBIO), Zhuhai, China, Vol. 15806574. 1670–1677 (IEEE). doi: 10.1109/ROBIO.2015.7419012
Kuffner, J. J., LaValle, S. M. (2000). “RRT-connect: An efficient approach to single-query path planning,” in Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065), San Francisco, CA, USA, Vol. 2. 995–1001 (IEEE). doi: 10.1109/ROBOT.2000.844730
Li, F., Liu, W., Stefanini, C., Fu, X., Dario, P. (2010). A novel bioinspired PVDF Micro/Nano hair receptor for a robot sensing system. Sensors (Basel Switzerland) 10 (1), 994–1011. doi: 10.3390/s100100994
Liang, L., Hui, P., Bai, C. (2011). Moving vascular micro-robot in pulsating flow field. Zhongnan Daxue Xuebao (Ziran Kexue Ban)/Journal Cent. South Univ. (Science Technology) 42 (12), 3784–3790. doi: 10.1088/1674-4527/11/3/009
Liu, J., Xu, T., Guan, Y., Yan, X., Ye, C., Wu, X. (2017). Swimming characteristics of bioinspired helical microswimmers based on soft lotus-root fibers. Micromachines (Basel). 8 (12), 349. doi: 10.3390/mi8120349
Liu, J., Xu, T., Yang, S., Wu, X. (2020). Navigation and visual feedback control for magnetically driven helical miniature swimmers. IEEE Trans. Ind. Inf. 16 (1), 477–487. doi: 10.1109/TII.2019.2913762
Meng, K., Jia, Y., Yang, H. (2019). Motion planning and robust control for the endovascular navigation of a microrobot. IEEE Trans. Ind. Inf. 16 (70), 4557–45661. doi: 10.1109/TII.2019.2950052
Keywords: navigation, closed-loop control, microrobot, electromagnetic actuated system, micro-environment
Citation: Huan Z, Wang J, Zhu L, Zhong Z, Ma W and Chen Z (2023) Navigation and closed-loop control of magnetic microrobot in plant vein mimic environment. Front. Plant Sci. 14:1133944. doi: 10.3389/fpls.2023.1133944
Received: 29 December 2022; Accepted: 14 February 2023;
Published: 08 March 2023.
Edited by:
Ning Yang, Jiangsu University, ChinaReviewed by:
Chang Kuo-Chi, Fujian University of Technology, ChinaDavid Navarro-Alarcon, Hong Kong Polytechnic University, Hong Kong SAR, China
Dandan Zhang, University of Bristol, United Kingdom
Copyright © 2023 Huan, Wang, Zhu, Zhong, Ma and Chen. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.
*Correspondence: Weicheng Ma, jing11@mail.ustc.edu.cn