仿生机器鱼运动控制算法研究

footnotesize A practical motion control strategy for a radio-controlled, 4-link and free-swimming biomimetic robot fish is presented. Based on control performance of the fish the fish's motion control task is decomposed into on-line speed control and orientation control. The speed control algorithm is implemented by using piecewise control, and orientation control is realized by fuzzy logic. Combining with step control and fuzzy control, a point-to-point (PTP) control algorithm is proposed and applied to the closed-loop experimental system that uses a vision-based position sensing subsystem to provide feedback. Experiments confirm the reliability and effectiveness of the presented algorithms.     

仿生机器鱼俯仰与深度控制方法

提出一种基于重心改变法的仿生机器鱼俯仰姿态与深度控制方法, 用于实现机器鱼水中的浮潜运动. 该方法利用一种可调整位置的配重块结构, 改变机器鱼的重心位置, 进而实现机器鱼俯仰姿态的调节. 在对机器鱼内部配重块位置和机器鱼俯仰角的关系进行分析的基础上, 对一定速度下机器鱼的深度与俯仰角的关系进行建模, 提出由于尾部形变引起的俯仰姿态变化的补偿方法. 文中给出机器鱼原形样机的相关实验, 分析验证配重块位置变化和机器鱼重心及其姿态的调整, 深度控制等在多种情况下的结果.     

Precise planar motion measurement of a swimming multi-joint robotic fish一种面向多关节机器鱼平面运动的精确测量方法

This paper presents a method for planar motion measurement of a swimming multi-joint robotic fish. The motion of the robotic fish is captured via image sequences and a proposed tracking scheme is employed to continuously detect and track the robotic fish. The tracking scheme initially acquires a rough scope of the robotic fish and thereafter precisely locates it. Historical motion information is utilized to determine the rough scope, which can speed up the tracking process and avoid possible ambient interference. A combination of adaptive bilateral filtering and k-means clustering is then applied to segment out color markers accurately. The pose of the robotic fish is calculated in accordance with the centers of these markers. Further, we address the problem of time synchronization between the on-board motion control system of the robotic fish and the motion measurement system. To the best of our knowledge, this problem has not been tackled in previous research on robotic fish. With information about both the multi-link structure and motion law of the robotic fish, we convert the problem to a nonlinear optimization problem, which we then solve using the particle swarm optimization (PSO) algorithm. Further, smoothing splines are adopted to fit curves of poses versus time, in order to obtain a continuous motion state and alleviate the impact of noise. Velocity is acquired via a temporal derivative operation. The results of experiments conducted verify the efficacy of the proposed method.     

3-D Locomotion control for a biomimetic robot fish

This paper concerns with 3-D locomotion control methods for a biomimetic robot fish. The system architecture of the fish is firstly presented based on a physical model of carangiform fish. The robot fish has a flexible body, a rigid caudal fin and a pair of pectoral tins, driven by several servomotors. The motion control of the robot fish are then divided into speed control, orientation control, submerge control and transient motion control, corresponding algorithms are detailed respectively. Finally, experiments and analyses on a 4-link, radio-controlled robot fish prototype with 3-D locomotion show its good performance.     

基于PPO算法的仿生鱼循迹智能控制

仿生鱼具有广阔的工程应用前景,对于仿生鱼的控制,首先要解决的是循迹问题.然而,现有的基于CFD方式和传统控制算法的鱼游控制方法存在训练数据获取成本高、控制不稳定等缺点.本文提出了基于PPO算法的仿生鱼循迹智能控制方法:使用代理模型替代CFD方式产生训练数据,提高数据的产生效率;引入高效的PPO算法,加快策略模型的学习速度,提高训练数据的效用;引入速度参数,解决鱼体在急转弯区域无法顺利循迹的问题.实验表明,我们提出的方法在多种类型的路径上均具有更快的收敛速度和更加稳定的控制能力,在仿生机器鱼的智能控制方面具有重要的指导意义.     

A 3D simulator for autonomous robotic fish

This paper presents a 3D simulator used for studying the motion control and autonomous navigation of robotic fish. The simulator's system structure and computation flow are presented. Simplified kinematics and hydrodynamics models for a virtual robotic fish are proposed. Many other object models are created for water, obstacles, sonar sensors and a swimming pool. Experimental results show that the simulator provides a, realistic and convenient way to develop autonomous navigation algorithms for robotic fish.     

基于立体视觉的串联机器人跟踪检测系统

建立一种六自由度串联机器人视觉跟踪检测系统框架,包括图像采集、摄像机标定、机器臂跟踪检测、机器臂位姿建模与计算等。提出利用CamShift算法对机器人进行在线粗跟踪,搜寻和画定出机器臂操作器在当前窗口的区域位置。对跟踪到的机器臂按照SURF算法进行特征提取与立体匹配。该方法被用于对串联机器人位姿检测进行实验。实验结果表明,2种算法的结合适用于六自由度串联机器人在空间复杂运动的跟踪检测。     

基于二阶一致性算法的多仿生机器鱼分布式编队控制

针对动态领航者按照自身动力学模型运动, 多个跟随者机器鱼以其为编队参考点, 根据编队要求形成队形并整体跟随领航者运动的问题, 提出一种多仿生机器鱼分布式编队控制方案. 首先, 基于二阶一致性算法给出各跟随者机器鱼估计领航者位姿信息的分布式算法;其次,给出以领航者为参考点的多仿生机器鱼编队描述方法,进而各机器鱼根据编队要求以所估得的参考点信息实时确定其在编队中的期望位姿; 再次, 各跟随者机器鱼以期望速度和角速度以及所估得的领航者位姿信息为输入, 利用模糊控制器确定其速度档位和方向档位, 实现编队的形成与保持. 仿真和实验结果均表明, 所提分布式编队控制方法是有效的, 仿生机器鱼群体能够较快形成期望队形并跟随领航者游动.     

Bio-harmonized control experiments of a carangiform robotic fish underwater vehicle

This paper presents experimental implementation and comparison of three different control schemes of a bio-inspired robotic fish underwater vehicle. The dynamics model is obtained by unifying conventional rigid body dynamics and bio-fluid dynamics of a carangiform fish swimming given by Lighthill’s(LH) slender body theory. It proposes an inclusive mathematical design for better control and energy efficient path travel for the robotic fish. The system is modeled as an two-link robot manipulator (caudal tail) with a mobile base (head). This forward thrust drives the robotic fish head represented by a combined non-linear equation of motion in earth fixed frame. We develop and compare the dynamic motion closed loop control strategy of the bio-harmonized robotic fish based on three different non-linear control schemes using CTM (Computed Torque Method), FF (Feed-Forward) controllers both with dynamic PD compensation and finally a proposed combination of CTM with FF. An inverse dynamic control method based on non-linear state function model including hydrodynamics is proposed to improve tracking performance. CTM control generates a feedback loop for linearization and decoupling robot dynamic model with a shorter response time, while a dynamic PD compensation in the FF path is employed by FF scheme through the desired trajectories. FF model-based strategy results in an improved tracking and shorter route to travel between two points. Overall results indicate that performances of the proposed control schemes based on the inverse dynamic model are comparable and useful for robotic fish motion tracking in fluid environment.     

Intelligent Control Algorithms for Robotic-Assisted Beating Heart Surgery

This paper focuses on the development of control algorithms for intelligent robotic tools that assist off-pump coronary artery bypass graft (CABG) surgery. In the robotic-assisted CABG surgery, the surgeon operates on the beating heart using intelligent robotic instruments. Robotic tools actively cancel the relative motion between the surgical instruments and the point of interest on the beating heart, dynamically stabilizing the heart for the operation. This algorithm is called active relative motion canceling (ARMC). Here, a model-based intelligent ARMC algorithm employing biological signals, such as electrocardiogram, to achieve effective motion cancellation is proposed. Finally, experimental results of the algorithm on a 3-degree-of-freedom robotic test-bed system are reported.     

基于二分图最大匹配的多机器鱼可控包含控制

考虑水下机器鱼的运动学约束及包含控制中的领导者选择问题,将可控性理论与包含控制相结合,针对有向多机器鱼系统,提出一种基于二分图最大匹配的多机器鱼可控包含控制算法.首先,针对有向多机器鱼网络拓扑结构,利用二分图最大匹配算法求得满足系统可控的驱动节点,即为领导者,其余节点为跟随者;其次,针对2D仿真机器鱼模型设计相应的包含控制协议,从而实现多机器鱼的可控包含控制,且最终跟随者鱼体前端刚体长边方向与领导者保持一致,并应用Lyapunov稳定性理论证明系统的稳定性;最后,基于URWPGSim2D多机器鱼仿真平台进行两组仿真实验,一组随机选取领导者,另一组采用二分图最大匹配算法确定领导者,对比仿真结果表明,所提算法能够有效地实现多机器鱼的可控包含控制.     

仿生机器鱼胸/尾鳍协同推进闭环深度控制

为改善机器鱼定深控制过程中的动态性能与稳态性能,根据深度误差的大小将定深控制过程分解为趋近阶段与巡游阶段,给出了一种基于中枢模式发生器（central pattern generator,CPG）与模糊控制相结合的闭环运动控制方法．为此,首先建立了以压力传感器信号为反馈输入,通过模糊控制器调节控制参数的CPG运动控制模型．在此基础上,针对误差较大的趋近阶段,采用胸/尾鳍协同方式,通过趋近模糊控制器改变摇翼关节的偏置量与幅值来使机器鱼快速到达期望深度;针对误差较小的巡游阶段,采用改变攻角方式,通过巡游模糊控制器改变胸鳍攻角来使机器鱼保持在期望深度．两阶段之间通过胸鳍CPG的启停实现切换．模糊控制器设计时利用了基于最小二乘法对实验数据拟合而得出的俯仰角变化率与控制参数的近似关系,提高了机器鱼趋向期望深度的速度并减小了在期望深度巡游时的稳态误差．仿真与实验结果验证了所提控制方法的有效性．     

Vision-Based Robotic Motion Control for Non-autonomous Environment

A visual servo control system with SOPC structure is implemented on a retrofitted Mitsubishi Movemaster RV-M2 robotic system. The hardware circuit has the functions of quadrature encoder decoding, limit switch detecting, pulse width modulation (PWM) generating and CMOS image signal capturing. The software embedded in Nios II micro processor has the functions of using UART to communicate with PC, robotic inverse kinematics calculation, robotic motion control schemes, digital image processing and gobang game AI algorithms. The digital hardware circuits are designed by using Verilog language, and programs in Nios II micro processor are coded with C language. An Altera Statrix II EP2S60F672C5Es FPGA chip is adopted as the main CPU of the development board. A CMOS color image sensor with 356 ×292 pixels resolution is selected to catch the environment time-varying change for robotic vision-based servo control. The system performance is evaluated by experimental tests. A gobang game is planned to reveal the visual servo robotic motion control objective in non-autonomous environment. Here, a model-free intelligent self-organizing fuzzy control strategy is employed to design the robotic joint controller. A vision based trajectory planning algorithm is designed to calculate the desired angular positions or trajectory on-line of each robotic joint. The experimental results show that this visual servo control robot has reliable control actions.     

机器鱼运动学SSPR 建模与自适应迭代学习控制

针对一类多关节机器鱼推进速度的调节, 提出一种运动学建模与控制匹配设计的新方法. 以可控性为目标, 建立了基于能量转化系数的鱼尾摆动规律与推进速度性能参考(SSPR) 模型, 系统已知参数把能量转化率收敛到一个可控可调节范围. 自适应迭代学习控制策略与之匹配, 能适时辨识并周期性地更新该模型的能量转化系数, 实现机器鱼在陌生水环境中的推进速度自调节. 仿真分析验证了该模型和控制方法的正确性.

     

基于CFD的仿鲹科机器鱼动力学建模与运动控制

仿生机器鱼的运动控制是仿生机器鱼推广应用的基础;然而,仿鲹科机器鱼的推进一般采用鱼体波数据,很少采用真实鱼类游动数据;为了深入探究仿鲹科机器鱼运动控制方法,采用了计算流体力学方法,通过标定流体介质、来流速度、鱼体几何形状等措施,利用Fluent软件进行了建模,然后针对鱼体波数据和真实金枪鱼游动采样数据两种不同推进数据对仿生机器鱼进行了仿真和实验;结果表明对于多关节仿生机器鱼推进方面,真实金枪鱼游动采样数据相较于常见的鱼体波产生的推进数据,在躯干进行大幅值摆动的情况下效果更好;这一仿真和实验对比为仿鲹科机器鱼的高效运动控制提供了一种新思路。     

Evaluation of a grey scale tactile array sensor pad for robotic applications

Since sensory feedback is an important part of robot control and the acquisition, manipulation, and recognition of objects, incorporating a sense of touch into a robotic system can greatly enhance the performance of that system. This article describes the evaluation of a recently developed low-resolution tactile array sensor pad system for use in robotic applications. Computer algorithms are developed which acquire data from the sensor pad and display the data on a CRT screen. Vision algorithms are implemented in order to extract the necessary information from the tactile data which will aid in the acquisition, manipulation, and recognition of objects. An object's pose is estimated by calculating its center of gravity (position) and principal axis (orientation). Recognizing an object and distinguishing between different objects is accomplished by implementing algorithms which estimate an object's perimeter (shape) and area (size). This work demonstrates that a low-resolution tactile array sensor is capable of providing the information that is required for many robotic applications in which objects must be acquired, manipulated, and recognized. Such a system provides a low-cost alternative to more conventional vision-based systems.     

Maneuvering and control of a biomimetic autonomous underwater vehicle

This work presents an approach for maneuvering and controlling a biomimetic autonomous underwater vehicle (BAUV). The BAUV swims forward by oscillating its body and caudal fin. It turns by bending its body and caudal fin toward the intended direction of motion. A body-spline function is specified by a set of parameters. Genetic algorithms are then used to find the values of the parameter by evaluating a fitness function over several swimming trials in a water tank. The fitness function is defined as the ratio of the kinetic energy of the forward motion to the required driving power of the joint motors. A control law that uses the oscillating frequency to control the forward speed, and applies a body-spline offset parameter to control the yawing rate is proposed. Moving averages of swimming speeds and heading angles are utilized as feedback signals to control the forward speed and heading angle of the BAUV. The effectiveness of the control algorithm is experimentally confirmed.

A Pseudo-Distance Algorithm for Collision Detection of Manipulators Using Convex-Plane-Polygons-based Representation

Robots have become indispensable parts for the industrial automated workshop. The distance calculation between the industrial robot and obstacles is a fundamental problem for the robotic collision-free motion control. But existing methods for this problem have the disadvantage that the accuracy and execution efficiency cannot be guaranteed at the same time. In this paper, a pseudo-distance algorithm is presented based on the convex-plane-polygons-based representation to solve this problem. In this algorithm, convex plane polygons (CPPs) and cylinders are utilized to represent obstacles and the manipulator, respectively. The spatial relationship between each CPP and each cylinder is discussed through defining condition parameters, and is divided into six conditions including three special conditions when the contact happens, and the other three conditions when there exists a certain distance between the CPP and the cylinder. The distance is modelled under different relations based on the theory of mathematics and geometry. The pseudo distance is determined through selecting the smallest value from distances between CPPs and cylinders. The numerical experiment is performed based on the proposed and two previous algorithms to estimate the shortest distance between an industrial robot and a groove-shape obstacle. And an application example is performed to show the significance of this work on the robotic motion control. Results indicate that the proposed algorithm is more efficient than previous algorithms under a certain precision requirement, and can be effectively applied in the robotic motion control.     

Time-optimal tool motion planning with tool-tip kinematic constraints for robotic machining of sculptured surfaces

A time-optimal motion planning method for robotic machining of sculptured surfaces is reported in this paper. Compared with the general time-optimal robot motion planning, a surface machining process provides extra constraints such as tool-tip kinematic limits and complexity of the curved tool path that also need to be taken into account. In the proposed method, joint space and tool-tip kinematic constraints are considered. As there are high requirements for tool path following accuracy, an efficient numerical integration method based on the Pontryagin maximum principle is adopted as the solver for the time-optimal tool motion planning problem in robotic machining. Nonetheless, coupled and multi-dimensional constraints make it difficult to solve the problem by numerical integration directly. Therefore, a new method is provided to simplify the constraints in this work. The algorithm is implemented on the ROS (robot operating system) platform. The geometry tool path is generated by the CAM software firstly. And then the whole machine moving process, i.e. the feedrate of machining process, is scheduled by the proposed method. As a case study, a sculptured surface is machined by the developed method with a 6-DOF robot driven by the ROS controller. The experimental results validate the developed algorithm and reveal its advantages over other conventional motion planning algorithms for robotic machining.     

Analysis and Verification of Repetitive Motion Planning and Feedback Control for Omnidirectional Mobile Manipulator Robotic Systems

Mobile manipulator robotic systems (MMRSs) composed of a manipulator and a mobile platform are investigated in this paper. In order for the mobile manipulator robotic system (MMRS) to return to its initial state when the manipulator’s end-effector is requested to execute cyclical tasks, a quadratic program (QP) based repetitive motion planning and feedback control (RMPFC) scheme is proposed and analyzed. Such an RMPFC scheme can not only mix motion planning and reactive control, but also consider the physical limits of the robotic system. Mathematically, the efficacy of the RMPFC scheme is verified via gradient dynamics analysis. To further demonstrate the effectiveness of the RMPFC scheme, a kinematically redundant MMRS composed of a three degrees-of-freedom (DOF) planar manipulator and an omnidirectional mobile platform is designed, modeled and analyzed. Then, repetitive motion planning and feedback control for the designed omnidirectional MMRS is studied. Besides, a numerical algorithm is developed and presented to solve the QP and resolve the redundancy of the robotic system. Moreover, computer simulations are comparatively performed on such an omnidirectional MMRS, and simulation results substantiate the effectiveness, accuracy and superiority of the proposed RMPFC scheme.