For decades, researchers have made massive efforts to make machines intelligent, in expectation of relieving human labors from repetitive, dangerous, and heavy work. In traditional robotics, control of robots is realized by establishing kinematic and dynamic models in the form of a transformation matrix. This method has achieved excellent results in conventional robots with discrete rigid links but becomes difficult to implement when dealing with soft robots such as continuum robots. In the traditional method, several subjective assumptions have to be made to get control of continuum manipulators, leading to a deviation with actual circumstances and inaccurate in results [1]. Even though, the kinematic and dynamic models for continuum robots are often described in the form of nonlinear partial differential equations, which makes the control more complex.
Ever since reinforcement learning (RL) theory was proposed, developers have been trying to apply it to robotics. With introducing RL methods, it enhances the traditional method in rigid robotics with trial-and-error [2] [3]. But the application of RL theory in continuum robots could still meet some resistance. As far as we were concerned, recently only a few studies have applied RL to control continuum robots. In Thuruthe et al.’s research [4], an accurate Vicon tracking system is provided for realizing closed-loop control from the third-person perspective. However, devices used in their research are not available for most application scenarios of continuum robots. Furthermore, data-inefficiency is the major drawback of RL algorithms, especially in a non-stationary continuum robot, which can make the learning on the real-world robot more impractical.
In this paper, we focalize automatic kinematics learning of complex robotic systems and end-to-end predicting control by using a visual servo from a first-person perspective. The primary problem we tackled is the data-efficiency of complex and non-stationary real-world robotics. We use the inexplicit prior knowledge to speed up the convergence of the learning process. Meanwhile, the ability of exploration is still guaranteed by an auto-adjusted exploitation coefficient.
To evaluate our proposed method empirically, we build a simulator by MuJoCo [5] first and then try on a real-world continuum robot directly. Our primary contributions are as follows:
• An efficient model-based RL framework for robotics that integrates inexplicit prior knowledge (IPK) is proposed. It guides the exploration followed the constrain of priors;
• A Kalman filter based fusion controller fuses action distributions from priors and RL to achieve a safe exploration;
• To balance the performance of priors and RL, we set an exploitation coefficient that can adjust automatically according to the Kullback-Leibler (KL) divergence between two action distributions;
• Results of simulation and experiment on real-world continuum robot demonstrate the data-efficiency of our method and require fewer interactions than the state-of-the-art model-based methods.
A. Model-based Reinforcement Learning
The word model-based is easily ambiguous, which can both represent a given model in MPC and a learned model mainly used in RL. In this paper, model-based means a model learned from the trajectory data when either the system dynamic model or the environment model is unknown.
Model-based reinforcement learning (MBRL) began with Dyna [6] architecture. Compared to model-free reinforcement learning (MFRL), it is undoubtedly more suitable for robotic systems because of the data-efficiency of taking full advantage of experience data. Since MBRL uses a learned dynamic model to promote the learning process, its uncertainty will bring incorrect transition and impair value function approximation [7]. MVE [8] controls the uncertainty of the model by limiting the imagination of the model to a fixed depth. STEVE [9] improves the thought of MVE by dynamically interpolating between model rollouts of a different horizon length of each example and ensures that models are used without redundant errors.
Furthermore, probabilistic models that usually relay on Bayesian methods are more suitable for robotics issue since they can combine the uncertainty into model building [10]. Black-DROPS [11] and PILCO [12] both utilize Gaussian Processes (GPs) to reduce the interaction time and solve several robotics tasks. On the basis of GPs, Bayesian NN (BNN) [13] has been used in some work to improve the scaling of MBRL algorithms [14]. Chua et al. [15] propose a combination of ensembles and BNN recently for learning probabilistic dynamics models of higher dimensional systems.
Most recently, Michael et al. [16] propose a monotonic model-based policy optimization (MBPO) algorithm. MBPO combines the benefits of adaptive length planning and ensemble BNN models to provide a performance guarantee and get a state-of-the-art efficient performance on several common RL tasks.
B. Reinforcement Learning with prior knowledge
Although MBRL algorithms achieve infusive success, they still take too many time steps (e.g., the state-of-the-art MBRL method MBPO still needs 5k steps even for a simple Pendulum task) which still impractical in real-world robot application. Recently, a comprehensive survey on policy search algorithms for learning robot controllers in a handful of trials is worth reading [10]. Except for creating data-driven surrogate models as MBRL algorithms do, the article states that there is another way to let robots adapt with micro-data: leverage prior knowledge on the policy parameters [17] [18], on the expected return [19], or on the dynamic models [20] [21]. We can bring some prior knowledge of the robot system in for both stable and efficient, rather than merely learning from scratch.
Similarly, as flourishing fields, Imitation Learning (IL) and Reinforcement Learning from Demonstrations (RLfD) also use expert demonstrations as a prior for accelerating the training process. They integrate expert data by behaviour cloning [22] [23] [24], data augmenting [25], or setting as a policy penalty [26] [27] or a constraint [28].
In addition, priors can use in a stronger way for some tasks. Moreno et al. [29] add a set of prior knowledge sources as a basic controller and use a credit assignment block to judge when to explore by RL. However, the evaluation function is designed by hand and just acts as a conditional judgment.
C. Continuum Robot Control
Continuum robots have many usages in flexible scenes, especially in interventional medicine field, because they theoretically have infinite Degrees of Freedom (DOF) [30].
Studies on control of continuum robots have been widely explored in traditional methods [31]. Researchers tend to establish the manipulator kinematic and dynamic models derived from several geometric assumptions. The most commonly used model simplifies the control issues based on the constant curvature (CC) approximation and linearized feedback [1] [32]. This CC model performs worse when external loads are non-negligible [33] [34]. As an alternative, mechanics-modified models were used in continuum robotics. Walker, Hannan and Gravagne have introduced the hyper-redundant robotics [35] [36] and large-deflection dynamic model was used in their researches [33]. Considering the backbone of continuum robots as an elastic rod, Webster et al. [37] and Mahvash et al. [38] have respectively applied Cosserat rod model in their researches. Although an increase in accuracy is found, solutions of those models, described in the form of nonlinear partial differential equations, are sensitive to parameters and time-consuming [34] [39], which inevitably increases the complexity of the control issues in continuum robotics.
Like other RL problems, we need first simplify the sequential decision procedure as a Markov Decision Process (MDP). Then abstract it into :
• Observation o: Observation contains two parts: states of the target and accumulated actions. States of target are obtained from the view scope of the pinhole camera at the end of the continuum. They consist of the horizontal and vertical coordinate components w, l and the Euclidean distance h between the camera and the target, as shown in Fig.1. Accumulated actions are obtained by adding executed actions throughout the trajectory;
• Action a: Actions are the control values of four motors, each is between (0, 1);
• Reward r: The raw reward is the amount of observation change between current observation and next observation. There are also some special scenes need to amend the raw reward which are listed below:
Fig. 1. View scope from the pinhole camera at the end of the continuum robot. A coordinate system is established with approximate directions of four motors of the continuum robot as the coordinate axis (see the details in IV.A). represents the positive direction of motor n in our task. Distance h is obtained by a simple digital image process technique.
As we want to introduce both model-based and prior knowledge into robotics RL problems, the strategy of building surrogate models and leveraging prior knowledge (Section IV.A) need to be selected carefully. In this article, we build a probabilistic surrogate model for a dynamic system. We model the robots as discrete-time dynamical systems that can be described by transition probabilistic of the form:
Use the trajectories observed so far to learn ensemble BNN models. Given n observation-action pairs as training inputs and corresponding training targets
. The reason why we use differences as model targets is that differences are easier to learn than original observation. Learning differences is similar as learning gradients. Therefore, we can use these models to estimate the probabilistic mentioned above and make a planning [40].
Before elaborating on our method, imagine a simple daily scene. When you are asking for directions in an unknown area, you can just get an answer like “go straight and turn left at the third corner”, rather than an explicit map. In the beginning, you might be confused about the whole trajectory, but when you go straight, you will definitely know when to turn left!
Humans always have some intuitive inexplicit prior knowledge (IPK) about how to control robots, like “it (a rigid manipulator) should raise the third joint to catch the ball” or “it (a mobile robot) should go forward and turn right to enter the room”. It might be inaccurate, but is generally on the right path. To avoid useless exploration in a complex manipulator system, the general trend of movement can be pointed out and taught to the ignorant robot. All it needs to do is continuing amending the movement trend mapping from data and finally get reliable and explicit mapping. According to this idea, the main framework of our method is shown in Fig. 2. The full algorithm is outlined in Appendix C Algorithm 1.
Fig. 2. The main framework of our method contains two parts: IPK subsystem and MBPO subsystem. Light pink IPK subsystem, which includes both Basic Controller for initial exploration and Fusion Controller for stable longterm control, is the real agent policy to interact with the environment. The lilac MBPO subsystem obtains estimated rewards and observations from IPK, outputs the action distribution of its policy to fuse with basic action distribution, and finally constitutes a fusion policy.
A. Exploration guided by the prior knowledge
Fig. 3. Take the two-DOF tendon driven continuum robot as an example, the blue star in the top figure is above the central axis, thus the red tendon needs to be wound up, and the green one needs to be released. The bottom figure vice versa. At the end of the black elastic rod, there is a pinhole camera to provide a first-person perspective.
The so-called inexplicit in this article represents the approximate direction of each tendon motor. As shown in Fig. 3, the motor at the end of the red line determines the rise of the robot, and the green one determines the downwards direction. Thus, we can build a coordinate axis in Fig. 1 using these approximate directions. This kind of information is much easier to obtain than a kinematic model and certainly not precise. They can be obtained by powering up each motor and recording their specialty. Different from the expert demonstrations in IL and RLfD fields, the condition of inexplicit prior knowledge is stronger. This prior knowledge can be regarded as a basic rule-based controller. It provides the simplest way to control a robot. Before each interaction, the target direction is first confirmed from the first-person perspective camera. Then calculate horizontal and vertical coordinate components (w, l). Finally, randomly select a motor in that direction to perform the motion or
or
.
Because of suffering from the inaccuracy and not wasting time on tuning a PID function, this basic controller has many drawbacks:
• When the target is close to the center of view, it is easy to oscillate around the target and never converge;
• As the degree of bending becomes greater, the approximate is much more inaccuracy, especially when bending from two vertical directions acts simultaneously;
• Since motors in the same direction are selected randomly in the basic controller, it is powerless for achieving the distance keeping task.
Therefore, we also need RL exploration to amend the observation-action mapping. The integration of priors intends to prolong the length of the RL task horizon and tries to make it possible to sample more successional observation-action pairs. In this paper, we adopt the soft actor-critic (SAC) [41] as our policy gradient algorithm and MBPO as our MBRL algorithm. The primary procedure of MBPO is to employ a uniform policy that generates random actions to guarantee the exploration scope. However, this will lead to a major risk of a robot crash
Fig. 4. Left: Reparameter trick in SAC paper; Right: Before the reparameter trick, the output Gaussian distribution from the MBPO controller is fusing with distribution from the basic controller by Kalman filter.
and may cost a tremendous amount of time to reset. Both of them are insufferable in a real-world application.
We tackle this by setting two sets of interaction outputs, one from the IPK basic controller and another from MBPO. As shown in Fig.2, the replay buffer is augmented from to
, where the subscript real stands for information from IPK subsystem which does the real interaction. Both real and mbpo contain two parts, real contains initial exploration procedure bas and fusion procedure fus, e.g.,
. Correspondingly, the subscript mbpo contains uniform initial exploration procedure uni (which is not shown in Fig.2) and Gaussian policy learning procedure gau, e.g.,
. Actions from IPK subsystem is used for practically interacting with the environment and get the real reward
and the real next observation
. In contrast, MBPO information is merely used in policy updates.
We first describe the exploration approach of the initial exploration procedure in this chapter and elaborate on the fusion and learning procedure later. According to , the approximation of reward
and next observation
can be estimated by local linearity:
Intuitively, IPK actions guarantee that robots will eventually reach their target with a high probability, and the MBPO part can still improve its policy with a certain degree of precision. Therefore, the initial exploration procedure achieves a safe exploration. It implements once and gain twice experience, it is obviously more efficient than the vanilla MBPO does (more details in IV.C Data Augment).
B. Fusion Controller
After the initial exploration procedure, MBPO trains a Gaussian policy as the main learning policy which outputs Gaussian distributions of actions. Correspondingly, the IPK subsystem also turns into a new link: Fusion Controller.
Although MBPO disentangles the task horizon and model horizon by querying the model only for short rollouts, it is still limited by the probability of reaching the target, especially in sparse reward problem. Since the IPK basic controller is rule-based, it is convenient to assess its performance. From the initial replay buffer and the log of their task length, we can revert the data to the full form. At each time step, we can get the vector of target both before and after the action, then the deviation of each action from anticipative direction can be easily estimated. These deviations can be depicted as a Gaussian distribution (more details in IV.C Basic Controller Accuracy Estimation). Moreover, the raw actions of SAC are also Gaussian distribution. How can we use both of these useful information?
A very naive thought is fusing the basic output Gaussian with the SAC action distribution. Kalman filter is a common method to fuse the measurement information of multiple sensors and tend to be more accurate than each of them. As Fig. 4 shown, we use a Kalman filter to integrate outputs from both two controllers and acquire a new fusion distribution. This procedure is before the reparameter trick of SAC.
Our motivation for introducing the IPK subsystem is to demonstrate and guide the MBRL algorithm in order to reduce wasting time on useless exploration at the beginning, but not limit it. Because some motions, like axial distance maintenance and real-time tracking, cannot gain enough information from IPK basic controller, they still need relay on the exploration. So the MBPO reward estimation here is more complicated. We set an exploitation coefficient to balance exploration and exploitation which is inspired by the temperature coefficient
in MBPO.
Theorem 4.1 (Exploitation Coefficient AutoAdjustment): Let be the Gaussian distribution from the
Gaussian policy and let
be the basic action distribution with uncertainty. Then the exploitation coefficient is related to the KL-divergence between these two distributions.
where is a target divergence for KL-divergence limiting.
Proof. See Appendix A.1.
By introducing KL-divergence into the reward function, the behaviour of the MBPO controller will similar to the basic controller gradually. Moreover, we set a negative target divergence to overcome the uncertainty of basic controller and trade-off exploration and exploitation. This approach is analogous to the behaviour cloning method in IL field [25].
Meanwhile, the exploitation coefficient also should be used in Equation 2 as a weight parameter and structure the final fusion function:
The policy evaluation step is similar to Soft Policy Evaluation [41], it ensures that we can obtain soft value function for any policy . However, we need to prove that the new policy will achieve higher value than the old one by limiting the KLdivergence.
Theorem 4.2 (Fusional Policy Improvement): According to Theorem 4.1 and Equation 5, let , the new policy of T +1 time step is
. Then
for all
with
.
Proof. See Appendix A.2.
Implement Soft Policy Evaluation and Fusion Policy Improvement repeatedly, the policy will eventually converge to the optimal as proved in SAC Theorem 1 [41].
In conclusion, RL controller is exploring and exploiting beneath the IPK subsystem, interaction with the real-world is IPK subsystem’s business. This design brings two advantages: safe interaction and exploration guided by human priors.
C. Implementation Details
KL-divergence between Multivariate continuous Gaussian distributions. Since the action dimension is related to DOF of the continuum robot, the action distribution is multivariate. In this task, our continuum robot has 4-DOF and we simply merge the two of same direction action distributions by sum up their means and average their variances. This would relax the restriction of motor selection in the same direction and help to explore more unaware trajectories which are not included in IPK. The KL-divergence between the simplified bi-variate Gaussian distributions can be represented by their means and covariance matrices:
where , the subscript 1 for IPK basic policy and 2 for MBPO Gaussian policy, n represents the number of variables and here n = 2.
Data Augment. The well-designed structure allows us to obtain two experience simultaneously in one interaction. The augmented dataset can be divided into two-part,
and
, and sample in proportion according to the trust of MBPO controller. The trust is reflected in the exploitation coefficient
we mentioned above. Data from the MBPO subsystem is gained by estimated, therefore it is necessary to assess its data availability by
. After weighted sampling, two-part of data is concatenated together and used to train both model-free SAC network and model-based ensemble BNN models. This ensures the policy to balance the real interaction and MBPO exploration beneath the interaction.
Basic Controller Accuracy Estimation. After initial exploration procedure, we can estimate the accuracy of the basic controller by the trajectory data in replay buffer. Since contains the direction of the target at time t, and
has the direction of time t + 1. We can use these information to estimate the performance of
by calculate the angle
between two directions (Fig. 5). For example, if
, then the real action direction of time t is
:
After collecting the unit deviation of the whole initial exploration trajectories, we can get its uncertainty described by Gaussian parameters, mean and covari- ance matrix
diag
. Since these parameters stand for deviation of unit actions (unit actions = [1, 1, 1, 1]), the action distribution for the actual actions is
. Then the action outputs of basic controller are turned into distributions that easy to fuse (in IV.B).
In this paper, we propose to train the continuum robot to aim at a target object by controlling the shift of multiple tendon drivers without the kinematic model, to track the movement
Fig. 5. Use the angle (red) between states of the target before and after action, the uncertainty of the basic controller can be estimated and then transform its action output into a Gaussian distribution (blue).
of the target, and to maintain a certain axial distance. In minimally invasive surgery, the speciality of target tracking and axial distance keeping is critical for surgeons to concentrate on the practice since lesions will vibrate as the patient’s breathing and other organ movements. To verify our idea, we first carry out experiments in a designed simulator and analyze ablations of it. Then we deploy it directly to a real-world continuum robot we designed.
A. Simulation
We use Mujoco to build a continuum robot model, with the physical manipulator to be referred. It can be divided into two motion sections, each of which is composed of 10 serial connected joints. Both of the sections are actuated by two sets of tendon-driven system at the end-point and have two-DOF separately. The panorama of the simulator is illustrated in the left of Fig. 6. We generate a set of space curves randomly by cubic spline (Fig. 7). Points on the curves are all in the workspace in order to simulate the distance keeping task and ensure that the target is within reach.
Fig. 6. Left: The panorama of tendon-driven continuum robot simulator based on Mujoco; Right: The continuum robot continuing tracking the target.
Following existing studies, we use the epoch return to evaluate the performance of different algorithms. It calculates the transformation of 3-dimension Euclidean distance after each step, reward when the target reaches the visual center and punish when out of the field of view. To maintain the axial distance, the change of distance is also treated as a penalty. During the training process, each epoch has 1000 time
Fig. 7. Generate a set of cubic splines (green) randomly in the workspace (between two spheres), and let the target update its position follow these trajectories. The black hexagons are sequential positions of the target. Threedimension trajectory in the workspace is propitious to estimate the distance keeping task.
steps with a 20 steps model rollout. Note that the performance comparison does not contain the exploration procedure. See the Appendix B for detailed parameters setting.
Baselines we compared are as listed below:
• Basic Controller: select actions followed the priors;
• SAC: the state-of-the-art MFRL algorithm using maximum entropy method;
• PILCO: a famous MBRL algorithm for robotics using GPs;
• MBPO: the state-of-the-art MBRL algorithm using ensemble BNN and adaptive length rollouts. Therefore, the comparison of these five methods is shown in Fig. 8.
Fig. 8. The performance comparison among basic controller, SAC, PILCO, MBPO and our method. We smooth the curves by 0.9 weight parameter.
From Fig. 8, we discover that by introducing inexplicit prior knowledge, the IPK improves faster than the others. At the second epoch, the IPK reaches and surpasses the basic controller more quickly than the other three SOTA algorithms. It also converges at a higher return after a few epochs. For the two MBRL algorithms, they both converge at a lower return. The primary reason is that both of them have not learned a comprehensive dynamic model because of the short task length. We will analyze this reason at Section IV.C in detail. Because of lacking the planning of the learned model, SAC’s performance is worse than others as we assumed.
Surprisingly, though acting followed rules, the performance of the basic controller is still at a low level. After checking videos saved during simulation, we find that it is very common for the continuum to oscillate near the origin under the control of the basic controller. Besides, the penalty of distance keeping also leads to this situation. Then a question occurs to us, how can these inexplicit prior knowledge assist our algorithm to gain such a high return?
From the video log, we figure out that it might benefit from the well-designed exploitation coefficient . Fusion controller can use the exploration of RL to amend the action value under soft constraints of rules, especially when it traps in vibration. In addition, since we merge the two motors of the same directions when calculating the KL-divergence, there is no constraint in selecting motors of the same direction. Therefore, it is easier for RL to explore a strategy to achieve the distance keeping task. The continuum can make S type movements (Fig. 6 Left) to shorten the distance. These are all the advantages of guaranteeing the exploration and we analyze this by visualizing the change of
below.
B. Ablation Study I: Trade-off
The most critical part of the IPK framework is action fusion. We record the mean KL-divergence between IPKMBPO (distinguished from the vanilla MBPO) and the basic controller, and the exploitation coefficient during the training process.
Fig. 9. The blue line represents the KL-divergence between IPK-MBPO Gaussian policy and the basic policy. The orange line represents the value change of the exploitation coefficient
In Fig. 9, we can discover that both KL-divergence and the exploitation coefficient descend through the training process. It demonstrates that the perfect performance of the fusion controller is not just relying on the basic controller but more focus on the data-driven IPK-MBPO controller. Moreover, it also confirms the exploitation coefficient auto-adjustment theory in Theorem 4.1.
C. Ablation Study II: Task length
In some cases, such as the target goes beyond the view scope, the environment needs to be reset. It means the current task is terminated. Short task length not only leads to low expected return but also impedes the model to learn the dynamics in the case with high curvature. Baseline algorithms are all wasting time on learning the dynamics near the plumb position again and again since the initial state of the task is vertically downward. As mentioned above, priors introducing intend to prolong the task length and to sample more successional action-state pairs. The average task length is recorded alongside the training process which is shown in Fig. 10.
Fig. 10. Task length of each algorithm.
The average task length of vanilla MBPO, PILCO and SAC are significantly shorter than our method. Due to the guidance of priors, the fusion controller can always reach the end of the task and seldom lose the target. It shows that exploration is safer when under the soft supervision or constraint of the priors.
D. Experiment on real-world continuum robot
To validate the effectiveness of the IPK algorithm, a real-world continuum robot is designed, the same as the mechanical structure described in simulation. The whole robot system is shown in Fig. 11. Plastic joints are evenly arranged and fixed on an elastic rod with large deflection, which provides necessary resilience as the backbone of the robot. Tendons are threaded through joints. Every two symmetrically arranged tendons attached to the same end-point can provide one DOF by producing strains in opposite directions. Transmission structures in such tendon-servo system sets are optimized by using screw rods with normal and reverse thread on both ends respectively. Then the two tendons linked with the same DOF can be driven by one servo motor, which avoids accuracy-loss caused by motor synchronization and structural redundancy. As a result, a one-to-one correspondence is formed between DOF and motors. The physical structure of this part is illustrated in Figure 12(a). In this way, the structure of the continuum manipulator is greatly simplified with lighter weight and higher accuracy to fit the simulation within the error range.
Same as simulation, the continuum robot needs some extra devices to perceive the experiment environment. A pinhole camera is fixed on the end-point to gather information for
Fig. 11. The 3D model of the whole robot system. The continuum robot is connected with a UR (Universal Robots) commercial manipulator. There are four micromotors at the base of the continuum which offer 4-DOF by positive inversion.
tracking tasks. Encoders on servo motors are used to ensure the IPK actions to be executed precisely, and protect the manipulator from being damaged in over range conditions. An extra camera is set up towards the robot, only for result evaluation. The gathered information is shown in Fig. 12(b).
Fig. 12. Devices and final results in real-world experiments. (a) Structure of the continuum robot. (b) Training processes in every epoch started from the zero position. (c) Mode I: The continuum manipulator was trained to tracking the target by using the visual observation, moving from state i to state ii for example. (d) Mode II: Height information of the end-point was gathered by image processing. With height information added into rewards, the continuum manipulator was trained to keep the distance during tracking tasks. Notice that state ii has a similar height with state i. Details as video.
The real-world experiment process was similar to that in simulation. Different from sim-to-real studies, the real-world model is not transformed from the simulation but directly learn from the real environment. In this case, the model can learn the uncertainty in the real environment and take these errors into account. The experiment was carried out mainly in two steps. Firstly, the continuum manipulator was trained in tracking objects by using visual observation (Fig. 12(c)). In this case, in order to shorten the training process, the real object was replaced by a screen that kept playing the video of simulated objects in a loop. Once the tracking task was failed or mechanical limits were reached, the manipulator would come back to the zero position with the help of encoders and prepare for the next training epoch. With the priorexperience of basic actions, after only half an hour, 10,000 steps, the robot gained an acceptable performance. Secondly, based on the already learned model in tracking tasks, height information of the end-point was added into rewards and made the manipulator learned to keep axial distance with the object (Fig. 12(d)). Then the robot would try to track the object with the least distance loss. After one half and an hour, 20,000 steps, the robot achieved convergence. Finally, the network weights were saved to reproduce the two tasks. The video of simulation and real-world experiments is available at https://youtu.be/MhqBSI-SXQc.
In this paper, we propose a new approach to integrating human prior knowledge into reinforcement learning robotics control. It takes full advantage of inexplicit prior knowledge and accelerates the learning process by guiding the policy search towards the approximate correct directions. Furthermore, the exploration of MBRL is also ensured by some learned coefficients. An empirical result which is given by visualizing the KL-divergence between action distributions proves our theory. By achieving the experiment we conducted, the designed continuum robot can assist the minimally invasive surgery.
Despite the delicate framework designing, the success is still merely proved in simple action space. We will focus on how to learn a combinatorial control of UR and continuum assembly efficiently and achieve the whole minimally invasive surgical procedure in our future work.
This work was supported by the National Natural Science Foundation of China (Grant No. 61973210), Shanghai Science and Technology Commission (Grant No. 17441901000), the Medical-engineering Cross Projects of SJTU (Grant Nos. YG2019ZDA17, ZH2018QNB23), and the Scientific Research Project of Huangpu District of Shanghai (Grant No. HKQ201810).
[1] B. A. Jones and I. D. Walker, “Kinematics for multisection continuum robots,” IEEE Transactions on Robotics, vol. 22, no. 1, pp. 43–55, 2006.
[2] D. Kalashnikov, A. Irpan, P. Pastor, J. Ibarz, A. Herzog, E. Jang, D. Quillen, E. Holly, M. Kalakrishnan, V. Vanhoucke, et al., “Qt-opt: Scalable deep reinforcement learning for vision-based robotic manipulation,” arXiv preprint arXiv:1806.10293, 2018.
[3] X. B. Peng, M. Andrychowicz, W. Zaremba, and P. Abbeel, “Sim-to-real transfer of robotic control with dynamics randomization,” in 2018 IEEE international conference on robotics and automation (ICRA), pp. 1–8, IEEE, 2018.
[4] T. G. Thuruthel, E. Falotico, F. Renda, and C. Laschi, “Model-based reinforcement learning for closed-loop dynamic control of soft robotic manipulators,” IEEE Transactions on Robotics, vol. 35, no. 1, pp. 124– 134, 2018.
[5] E. Todorov, T. Erez, and Y. Tassa, “Mujoco: A physics engine for model- based control,” in 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 5026–5033, IEEE, 2012.
[6] R. S. Sutton, “Dyna, an integrated architecture for learning, planning, and reacting,” ACM Sigart Bulletin, vol. 2, no. 4, pp. 160–163, 1991.
[7] G. Kalweit and J. Boedecker, “Uncertainty-driven imagination for con- tinuous deep reinforcement learning,” in Conference on Robot Learning, pp. 195–206, 2017.
[8] V. Feinberg, A. Wan, I. Stoica, M. I. Jordan, J. E. Gonzalez, and S. Levine, “Model-based value estimation for efficient model-free reinforcement learning,” arXiv preprint arXiv:1803.00101, 2018.
[9] J. Buckman, D. Hafner, G. Tucker, E. Brevdo, and H. Lee, “Sample- efficient reinforcement learning with stochastic ensemble value expansion,” in Advances in Neural Information Processing Systems, pp. 8224– 8234, 2018.
[10] K. Chatzilygeroudis, V. Vassiliades, F. Stulp, S. Calinon, and J.-B. Mouret, “A survey on policy search algorithms for learning robot controllers in a handful of trials,” IEEE Transactions on Robotics, 2019.
[11] K. Chatzilygeroudis, R. Rama, R. Kaushik, D. Goepp, V. Vassiliades, and J.-B. Mouret, “Black-box data-efficient policy search for robotics,” in 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 51–58, IEEE, 2017.
[12] M. Deisenroth and C. E. Rasmussen, “Pilco: A model-based and data- efficient approach to policy search,” in Proceedings of the 28th International Conference on machine learning (ICML-11), pp. 465–472, 2011.
[13] Y. Gal and Z. Ghahramani, “Dropout as a bayesian approximation: Representing model uncertainty in deep learning,” in international conference on machine learning, pp. 1050–1059, 2016.
[14] Y. Gal, R. McAllister, and C. E. Rasmussen, “Improving pilco with bayesian neural network dynamics models,” in Data-Efficient Machine Learning workshop, ICML, vol. 4, p. 34, 2016.
[15] K. Chua, R. Calandra, R. McAllister, and S. Levine, “Deep reinforcement learning in a handful of trials using probabilistic dynamics models,” in Advances in Neural Information Processing Systems, pp. 4754–4765, 2018.
[16] M. Janner, J. Fu, M. Zhang, and S. Levine, “When to trust your model: Model-based policy optimization,” in Advances in Neural Information Processing Systems, pp. 12498–12509, 2019.
[17] A. Billard, S. Calinon, R. Dillmann, and S. Schaal, “Survey: Robot programming by demonstration,” Handbook of robotics, vol. 59, no. BOOK CHAP, 2008.
[18] T. Osa, J. Pajarinen, G. Neumann, J. A. Bagnell, P. Abbeel, and J. Peters, “An algorithmic perspective on imitation learning,” arXiv preprint arXiv:1811.06711, 2018.
[19] A. Cully, J. Clune, D. Tarapore, and J.-B. Mouret, “Robots that can adapt like animals,” Nature, vol. 521, no. 7553, pp. 503–507, 2015.
[20] K. Chatzilygeroudis and J.-B. Mouret, “Using parameterized black-box priors to scale up model-based policy search for robotics,” in 2018 IEEE International Conference on Robotics and Automation (ICRA), pp. 1–9, IEEE, 2018.
[21] M. Cutler and J. P. How, “Efficient reinforcement learning for robots using informative simulated priors,” in 2015 IEEE International Conference on Robotics and Automation (ICRA), pp. 2605–2612, IEEE, 2015.
[22] S. Schaal, “Learning from demonstration,” in Advances in neural information processing systems, pp. 1040–1046, 1997.
[23] P. Abbeel and A. Y. Ng, “Apprenticeship learning via inverse rein- forcement learning,” in Proceedings of the twenty-first international conference on Machine learning, p. 1, 2004.
[24] M. Jing, X. Ma, W. Huang, F. Sun, and H. Liu, “Task transfer by preference-based cost learning,” in Proceedings of the AAAI Conference on Artificial Intelligence, vol. 33, pp. 2471–2478, 2019.
[25] S. Ross, G. Gordon, and D. Bagnell, “A reduction of imitation learning and structured prediction to no-regret online learning,” in Proceedings of the fourteenth international conference on artificial intelligence and statistics, pp. 627–635, 2011.
[26] T. Brys, A. Harutyunyan, H. B. Suay, S. Chernova, M. E. Taylor, and A. Now´e, “Reinforcement learning from demonstration through shaping,” in Twenty-Fourth International Joint Conference on Artificial Intelligence, 2015.
[27] B. Kang, Z. Jie, and J. Feng, “Policy optimization with demonstrations,” in International Conference on Machine Learning, pp. 2469–2478, 2018.
[28] X. Ma, M. Jing, W. Huang, F. Sun, C. Yang, B. Fang, and H. Liu, “Re- inforcement learning from imperfect demonstrations under soft expert guidance,”
[29] D. L. Moreno, C. V. Regueiro, R. Iglesias, and S. Barro, “Using prior knowledge to improve reinforcement learning in mobile robotics,” Proc. Towards Autonomous Robotics Systems. Univ. of Essex, UK, 2004.
[30] J. Burgner-Kahrs, D. C. Rucker, and H. Choset, “Continuum robots for medical applications: A survey,” IEEE Transactions on Robotics, vol. 31, no. 6, pp. 1261–1280, 2015.
[31] T. George Thuruthel, Y. Ansari, E. Falotico, and C. Laschi, “Control strategies for soft robotic manipulators: A survey,” Soft Robotics, vol. 5, no. 2, pp. 149–163, 2018. PMID: 29297756.
[32] M. W. Hannan and I. D. Walker, “Kinematics and the implementation of an elephant’s trunk manipulator and other continuum style robots,” Journal of robotic systems, vol. 20, no. 2, pp. 45–63, 2003.
[33] I. A. Gravagne, C. D. Rahn, and I. D. Walker, “Large deflection dynamics and control for planar continuum robots,” IEEE/ASME Transactions on Mechatronics, vol. 8, no. 2, pp. 299–307, 2003.
[34] D. Trivedi, A. Lotfi, and C. D. Rahn, “Geometrically exact dynamic models for soft robotic manipulators,” in 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 1497–1502, IEEE, 2007.
[35] I. A. Gravagne and I. D. Walker, “Kinematic transformations for remotely-actuated planar continuum robots,” in Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065), vol. 1, pp. 19–26 vol.1, 2000.
[36] M. Hannan and I. Walker, “Novel kinematics for continuum robots,” in Advances in Robot Kinematics, pp. 227–238, Springer, 2000.
[37] D. C. Rucker and R. J. Webster III, “Statics and dynamics of contin- uum robots with general tendon routing and external loading,” IEEE Transactions on Robotics, vol. 27, no. 6, pp. 1033–1044, 2011.
[38] M. Mahvash and P. E. Dupont, “Stiffness control of surgical continuum manipulators,” IEEE Transactions on Robotics, vol. 27, no. 2, pp. 334– 345, 2011.
[39] M. T. Chikhaoui, S. Lilge, S. Kleinschmidt, and J. Burgner-Kahrs, “Comparison of modeling approaches for a tendon actuated continuum robot with three extensible segments,” IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 989–996, 2019.
[40] S. Depeweg, J. M. Hern´andez-Lobato, F. Doshi-Velez, and S. Udluft, “Learning and policy search in stochastic dynamical systems with bayesian neural networks,” arXiv preprint arXiv:1605.07127, 2016.
[41] T. Haarnoja, A. Zhou, P. Abbeel, and S. Levine, “Soft actor-critic: Off- policy maximum entropy deep reinforcement learning with a stochastic actor,” arXiv preprint arXiv:1801.01290, 2018.
A. Proofs
1) Theorem 3.1: Let be the Gaussian distribution from the
Gaussian policy and let
be the basic action distribution with uncertainty. Then the exploitation coefficient is related to the KL-divergence between these two distributions.
where is a hyperparameter for KL-divergence limiting.
Proof. We aim to find a maximum entropy policy with a maximal expected return that satisfies a minimum distance between RL policy and inexplicit prior knowledge. This can be formalized as a constrained optimization problem.
where is the reward with maximum entropy which is defined in SAC as
.
Use Lagrange Multiplier Method to transform the constrained optimization problem into the unconstrained optimization
problem.
Therefore, the coefficient can be optimized by proceeding recursion after obtaining the optimal policy and Q function. Note that the T step optimal
is related to the
step optimal policy.
2) Theorem 3.2: According to Theorem 4.1 and Equation 5, let
, the new policy of T + 1 time step is
. Then
for all
with
.
Proof. Similar to the soft Bellman equation, we expand the Q value function to show the relationship with the exploitation coefficient . Here
is short for
.
Obviously, along with the improvement of the fusion policy, the KL-divergence between original policy and fusion policy is getting lower, leading to a smaller . Therefore, a higher Q value is guaranteed.
B. Hyperparameter
TABLE I HYPERPARAMETER
C. Pseudocode
Algorithm 1 Efficient Model-based Reinforcement Learning based on Inexplicit Prior Knowledge
4: Initialize exploitation coefficient 5: while poolsize < init exploration steps do
Initial exploration procedure
9: Store () in
10: end while
11: Estimate the accuracy of by
and turn into means
and variances
Uncertainty estimation 12: for epochs = 1, M do
Learning & Fusion procedure
13: Reset the environment, and get initial o
14: for timesteps = 1, N do Training BNN models
15: if timesteps % model train freq == 0 then
16: Train BNN models on with real data 17: Perform k-step model rollout; add to
18: end if
21: Estimate
22: Store () in
23: if ready to train then
Training SAC
24: Train soft Actor-Critic on with concatenate data of real and mbpo 25: end if
26: end for
27: end for