Yang 2015
Yang 2015
Abstract— In this paper, we have developed a method to in an economical perspective, and therefore may have great
tele-control a robot arm to imitate human writing skills us- potentials in compliant human robot interactions especially
ing electromyography (EMG) signals. The control method is in some physically coupling scenarios, e.g., rehabilitation or
implemented on the Baxter
R robot with a brush attached on
the endpoint of its arm to imitate human writing skills, and a daily cooperation tasks.
MYO sensor is used to measure the surface electromyographic Robots are now used for a wide range of different tasks in
(sEMG) signals generated by contractions of human muscles various situations, e.g., industry, medicine and research [5].
involved in writing tasks. A haptic device Sensable
R Omni is Nowadays, automatic robot technology is well developed, but
used to control the motion of the Baxter
R robot arm, and V-
there are still a lot of challenges for robots to deal with un-
Rep
R is employed to simulate the movement of the arm and to
calculate the inverse kinematic of Baxter
R robot arm. All the
certain environments. While artificial intelligence technology
communications for Baxter
R robot, V-Rep simulator, Omni still could not reach a level that is able to substitute human
device and MYO are integrated in MATLAB
/Simulink R
.
R decision, human controlled robots are preferred for most
The main test is to make the Baxter
R arm following the applications which need real time decisions. The process that
movement of a human subject when writing with Omni stylus, a human user controlling a slave robot remotely is called
and the EMG signals are processed using low pass filter and
moving average technique to extract the smoothed envelope teleoperation, which is important in many applications [6],
which is utilised to control the variation of position instead of e.g., remote robot is used to perform tasks in dangerous
variation of force along the vertical Z axis, so when the operator environment, for tasks that need to be done precisely, so that
writes with force variations, the Baxter
R can draw lines with an accurate movement is important. Conventionally, input
variable thickness. This imitation system is successfully tested devices such as keyboard, mouse or joystick are actually
to make the Baxter
R arm to follow the writing movement
of the operator’s hand and would have potential applications not following the instinct of human. Human users may need
in more complicated human robot teleoperation tasks such as training and practice to get used to it. The work in this
tele-rehabilitation and tele-surgery. paper attempts to control a robot arm by using both joystick
Keywords. Teleoperation, sEMG, V-Rep, Baxter
R robot. and EMG signals. The proposed method would be useful in
various applications. For example, in medicine surgery[7],
I. INTRODUCTION robot assisted surgery enhances the accuracy and dexterity
Research of human motor behaviors reveal that human of a surgeon by human adaptive muscle variations which can
arm can be stabilized mainly dependent on mechanical make the knots firm enough to keep the sutures compliant.
impedance control during interaction with dynamic envi- To extract the muscle variations needed for the action, there
ronment [1]. This control method minimizes the interaction are mainly two methods: one is to measure the force by a
force and performance errors. Inspired by these research re- force sensor, and the second is to exploit the EMG signals
sults, biomimetic learning controllers are proposed in [2], [3], which are generated when muscle activations occur. In this
[4] which are able to adapt trajectory, force and impedance paper, we extract smoothed EMG envelope to denote the
in the presence of unknown dynamics at same time. Com- variations of human muscle activity and apply it in human
pared to traditional robotic controllers, they are human- robot tele-handwriting.
like enabling robots to have some human motor features II. P RELIMINARY
This work was supported in part by EPSRC grants EP/L026856/1 and A. Baxter
R Robot
EP/J004561/1, National Natural Science Foundation of China (NSFC) under Baxter
R is a two-arm robot built by Rethink Robotics[8]
Grant 61473120, Guangdong Provincial Natural Science Foundation of
China 2014A030313266, State Key Laboratory of Robotics and System shown in Fig. 1. It is 5 to 6 feet tall, 306 lbs weight with
(HIT) SKLRS-2014-MS-05, the Program for New Century Excellent Tal- pedestal and 7 DOFs per arm, and it is equipped with 360
ents in University under Grant NCET-12-0195, and National High-Tech degree sonar for human presence detection and changeable
Research and Development Program of China (863 Program) Grant No.
2015AA042303. end-effectors. It is used in simple industrial tasks such as
1 Center for Robotics and Neural Systems, Plymouth University PL4 8AA, loading, unloading, packaging and kitting, machine tending
UK or material handling. Different accessories can be used on
2 Key Laboratory of Autonomous System and Network Control, Col-
lege of Automation Science and Engineering, South China University of
Baxter
R platform such as vacuum cup gripper, electric
Technology, Guangzhou, 510640, P. R. China parallel gripper and mobile pedestal.
3 State Key Lab of Robotics Systems, Harbin Institute of Technology,
The feature of the Baxter
R lies in its intrinsic safety. Many
Harbin, 150001, P. R. China. existing robots used in industry are built to complete tasks
4 Department of Mechanical and Industrial Engineering, Concordia Uni-
versity, Montreal, H3G 1M8, Canada. rapidly, most of the components are moving in very fast
* Corresponding author. Email: [email protected] speed in order to increase efficiency, and lack of safety
C. Workspace matching In this paper, low pass filter and moving average technique
described in (3) are used to track to muscle variation change
Since the workspaces between Phantom Omni and the with 8 channel raw EMG data (Fig. 5) using algorithm shown
arm of Baxter
R are quite different. A workspace mapping in Fig. 6. Fig. 7 is an example of EMG signal smoothing with
method which can be used to match the workspace between 20 samples window, as the EMG signals vibrate in a fast
Phantom Omni and Baxter
R was developed in our previous frequency. The 8 EMG signal readings are added together
work [12], and the matching result is shown in Fig. 3. The and put into a simple moving average function block and
2265
(a) (b)
Fig. 3: Workspace matching. (a) Workspace matching result represented at the XY plane; (b) Workspace matching result
represented at the xz plane.
2266
joint, which is not the position of the tip of the stylus.
Therefore the position information has to be modified to
extract the correct position of the Omni stylus tip.
Fig. 8 shows the overall design of the system used in this
paper. It is implemented according to the following steps:
• Finally it sends the joint angles to the Baxter robot, To test the effect of the error correction, the stylus tip is
Baxter will then writes on a paper and provide vision standing at a fixed point and the stylus is turned to different
feedback to the operator. orientation. As shown in Fig. 9, the position data varies
before correction, which is not desired because the stylus
A. Position calibration tip does not move.
The Cartesian position data provided by the OpenHaptics
toolkit is corresponding to the position of the crosspoint
between the 5th and the 6th joint axis, not the position of
the stylus tip. In order to obtain the position of the stylus
tip, orientation of the stylus is also needed, and this is also
provided by OpenHaptics toolkit API. The orientation of
the stylus can be found in the homogeneous transformation
matrix, in which the left top 3x3 sub matrix is the orientation
matrix of the stylus and the right top 3x1 vector is the
position of the crosspoint mentioned before. In order to
calculate the position of the stylus tip, it just need to put
the transformation matrix into a simple equation as shown Fig. 9: Position comparabilities before and after correction.
below:
T T
xt yt zt 1 = Tr × Dx Dy Dz 1 (4) B. Control implemented in Simulink
where xt , yt , zt are the Cartesian position of the stylus tip, Tr Fig. 10 shows the block diagram of the system used in the
is the transformation matrix and Dx , Dy , Dz are the distance paper, in which the block on the left is an S-Function used
between the crosspoint mentioned before and stylus tip to connect with the Phantom Omni by using OpenHaptic
2267
Tool-kit API. The five blocks in the middle are used to shown below:
perform the position correction and workspace mapping to [∼, ∼] = v.vrep.simxGetJointPosition(v.vrep.clientID,
the position and orientation data from the Omni S-Function. jointhandle, v.vrep.simxo pmodestreaming + al pha);
The three blocks on the top are used to receive and perform
moving average to the EMG signals from MYO armband. After this command is sent to V-Rep, the V-Rep server
The position data and muscle activation data are then fed will continuously executing that command and sent the joint
into the MATLAB function at the right, to calculate the position to MATLAB. In MATLAB, when the data need to
position for the Baxter end-effector and transmit to the be received, execute the following codes
V-Rep by sending it to the V-Rep S-Function. Finally [∼, ∼] = v.vrep.simxGetJointPosition(v.vrep.clientID,
the joint angles read from V-Rep simulation by V-Rep jointhandle, v.vrep.simxo pmodeb u f f er)
S-Function is sent to the Baxter S-Function. and the variable in MATLAB will be refreshed. This method
should minimize the delay cause by waiting for response.
2268
Fig. 15: “BAX” “BAX”written by Baxter
R
Fig. 12: Position of styles and Baxter
R end-effector.
R EFERENCES
[1] E. Burdet, R. Osu, D. W Franklin, T. E Milner, and M. Kawato.
The central nervous system stabilizes unstable dynamics by learning
optimal impedance. Nature, 414(6862):446–449, 2001.
[2] E. Burdet, G. Ganesh, C. Yang, and A. Albu-Schäffer. Interaction
force, impedance and trajectory adaptation: By humans, for robots.
In Oussama Khatib, Vijay Kumar, and Gaurav Sukhatme, editors,
Experimental Robotics, volume 79 of Springer Tracts in Advanced
Robotics, pages 331–345. Springer Berlin Heidelberg, 2014.
[3] C. Yang, G. Ganesh, S. Haddadin, S. Parusel, A. Albu-Schaeffer, and
E. Burdet. Human-like adaptation of force and impedance in stable
and unstable interactions. Robotics, IEEE Transactions on, 27(5):918–
Fig. 13: Position error between omni and Baxter
R end- 930, Oct 2011.
[4] C. Yang, Z. Li, and E. Burdet. Human like learning algorithm for
effector. simultaneous force control and haptic identification. In Intelligent
Robots and Systems (IROS), 2013 IEEE/RSJ International Conference
on, pages 710–715, Nov 2013.
[5] A. M Okamura. Methods for haptic feedback in teleoperated
As shown in Fig. 14 below, the Baxter
R can follow the
robot-assisted surgery. Industrial Robot: An International Journal,
operators hand to write a recognisable “BAX” with lines of 31(6):499–508, 2004.
different thickness. [6] N. Mavridis, G. Pierris, P. Gallina, Z. Papamitsiou, and U. Saad. On
the subjective difficulty of joystick-based robot arm teleoperation with
auditory feedback. In GCC Conference and Exhibition (GCCCE),
2015 IEEE 8th, pages 1–6. IEEE, 2015.
[7] F. Arai, M. Tanimoto, T. Fukuda, K. Shimojima, H. Matsuura, and
M. Negoro. Multimedia tele-surgery using high speed optical fiber
network and its application to intravascular neurosurgery - system
configuration and computer networked robotic implementation. In
Robotics and Automation, 1996. Proceedings., 1996 IEEE Interna-
tional Conference on, volume 1, pages 878–883 vol.1, Apr 1996.
Fig. 14: “BAX” pre-written to be follow. [8] Baxter robot profile. http://www.rethinkrobotics.com/
products/baxter/. Accessed: 2014-05-01.
[9] Z. Li P. Liang, C. Yang and R. Li. Writing skills transfer from human
to robot using stiffness extracted from semg. June 2015.
V. C ONCLUSION [10] haptic-phantom-omni profile. http://http://www.
dentsable.com/haptic-phantom-omni.htm. Accessed:
In this paper, a method to combine teleoperation joystick 2015-05-01.
Phantom Omni and the sEMG signals has been developed to [11] Geomagic openhaptics toolkit profile. http://www.geomagic.
com/en/products/open-haptics/overview/. Accessed:
control a robot arm writing recognisable words. The joystick 2015-05-01.
is used to control the motion on the horizontal 2D plan, [12] Z. Ju, C. Yang, Z. Li, L. Cheng, and H. Ma. Teleoperation of humanoid
while the muscle contraction activities extracted from sEMG baxter robot using haptic feedback. In Multisensor Fusion and Infor-
mation Integration for Intelligent Systems (MFI), 2014 International
are used to control the motion variation along the vertical Conference on, pages 1–6. IEEE, 2014.
direction to achieve variable thickness of writing with a [13] Myo in use. http://www.traceparts.com/
brush. In the presence of motion amplification when a master news-and-events/2014-press-releases/
pr01102014/. Accessed: 2014-05-01.
device’s workspace is much smaller than the workspace of [14] V-rep profile. http://www.coppeliarobotics.com/. Ac-
the slave robot, the most sensitive motion in vertical direction cessed: 2014-05-01.
is key to the success of writing task. Under the proposed [15] J.D. Wason and J.T. Wen. Robot raconteur: A communication archi-
tecture and library for robotic and automation systems. In Automation
method, the most sensitive motion in the vertical direction Science and Engineering (CASE), 2011 IEEE Conference on, pages
can be well controlled by the human operator using muscle 761–766, Aug 2011.
isometric contraction. For further improvement of the system, [16] Peter Corke. A robotics toolbox for matlab. Robotics & Automation
Magazine, IEEE, 3(1):24–32, 1996.
torque extraction from sEMG can be employed to ensure
force produced by robot arm is proportional to the activation
generated by the operator’s arm.
2269