Control Passive Mobile Robots For Object Transportation - Braking Torque Analysis and Motion Control
Control Passive Mobile Robots For Object Transportation - Braking Torque Analysis and Motion Control
net/publication/221068097
Conference Paper  in  Proceedings - IEEE International Conference on Robotics and Automation · April 2007
DOI: 10.1109/ROBOT.2007.363907 · Source: DBLP
CITATIONS                                                                                                 READS
12                                                                                                        289
4 authors, including:
            Kazuhiro Kosuge
            Tohoku University
            685 PUBLICATIONS   6,652 CITATIONS   
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Kazuhiro Kosuge on 21 January 2014.
manipulator control. An earlier work on developing ob-                                    IV. C ONTROL OF PASSIVE ACTUATOR
ject transportation system based on the concept of Passive                      Passive actuators have some unique controlling character-
Robotics is discussed in [6]. This system is designed by                     istics. The output of active actuators such as servo motor will
Peshkin and Colgate’s group. The system consists of motors                   affect the control target independent of the target’s motion.
for steering three passive wheels. The robot and object are                  However, the output of a servo-brake will not affect the
moved by the pushing force of the human operator, but                        motion of the target if it is not moving and will not move.
trajectory of the system is controlled by a steering wheel.                  This is a very important feature in realizing safety actions.
In our group, as well as active working helper system [7],                   Also some constraints make the control of passive type robot
we have developed a passive working helper [8][9] and it                     systems to be different from controlling ordinary systems.
consists of two MR brakes. This system assists user to                          Let us consider how the output torque of an actuator is
walk in environments with obstacles and it also provides                     applied to a mobile robot in the case of active and passive
proper dynamic characteristics to prevent the user from                      actuator such as motor and servo-brake respectively.
loosing his footing. However, the system is using normal
                                                                                (i) Motor Output Torque
wheels with non-holonomic constraints. Cobot also consist
of active type actuator even it is for passive application.                         It is well known that the torque applied to the wheel
Recently, Ryu and Pathak’s group also proposed a passive                            will be equal to the output torque of the motor as,
based control law for differentially driven mobile robot [11].                                            τm = km Im                     (1)
In this research, we focus on developing a robot system                             Im denotes the control input of a motor and km
consisting of passive actuators and investigate the dynamic                         denotes the torque constant of the motor. Without
characteristics and constrains of the system. We will also                          losing generality, the gear ratio is assumed as 1.
realize a motion control and object handling with a good                       (ii) Servo-Brake Output Torque
performance comparable to an active type system.
                                                                                    We consider the case that the PRP is moving by forces
                                                                                    applied by the human operator or other system. φ̇w and
                                                                                    few denotes the angular velocity of and external force
                                                                                    applied to the wheel respectively. Ib is input current to
                                                                                    the brake and kb is the torque coefficient of the servo
                                                                                    brake. Let τw denote the resultant torque applied to the
                                                                                    wheel from the brake. Then τw will be:
                                                                                      a) for φ̇w = 0
                                                                                                        τw = −kb Ib sgn(φ̇w )             (2)
  Fig.2 .   Hardware Design of PRP and Omni Wheel with MR Brake
                                                                                      b) for φ̇w = 0
           III. PASSIVE TYPE ROBOT P ORTER PRP                                                    
                                                                                                    −few Rw           |few |Rw ≤ kb Ib
   We have developed a passive type Robot Porter system                                    τw =                                           (3)
                                                                                                    −kb Ib sgn(few ) |few |Rw > kb Ib
based on the concept of the passive robotics and it is called
PRP-robot. PRP consists of three omni-directional wheels                            where, sgn(*) is the function to have sign of a param-
with servo-brakes to perform safety object transportation                           eter, and kb ≥ 0. Also as a brake, Ib ≥ 0.
task. The omni-directional wheel is equipped with several                       It is obvious that the characteristics of a brake-wheel
small rollers so that the wheel can generate driving force                   system are complicated compared with a motor-wheel sys-
along its rotational direction, but can move freely in its wheel             tem. It is dependent on the wheel rotation. The sign of the
axis. Each omni-directional wheel is directly connected to a                 output torque of the wheel is decided by the direction of
servo-brake, and the three wheels are arranged to have 2π/3                  the rotation of the wheel(Fig.3) and the magnitude of the
angle between each pair of wheel axes. A force/torque sensor
is installed on PRP for measuring the forces applied by the
human operator. It is necessary to note that the force sensor
is not indispensable to control of PRP if we do not need
to have precise dynamic characteristics, such as, impedance
characteristics of the system. Encoder is installed on each
wheel used for odometry. A computer system is installed for
controlling PRP and the system is powered by batteries.
   The control performance of PRP system depends on the
characteristics of the servo brakes installed. In the first
prototype, we used MR Brake. The braking torque of MR
Brake is generated by chain mechanisms of iron powder from
free flow state, which are reacting to the applied magnetic
field. This provides a very reliable and linear braking torque,
and relatively small power consuming compared with motors.                     Fig.3 .   Characteristic of Output Torque of Wheel with a Servo Brake
                                                                       2875
       Authorized licensed use limited to: TOHOKU UNIVERSITY. Downloaded on April 09,2010 at 06:05:01 UTC from IEEE Xplore. Restrictions apply.
                                                                                                                                                     ThD4.1
torque is proportional to the input current of the brake while                      torque on each wheel will follow the same relationship with
the wheel is rotating. On the other hand, the torque will                           the input current on the servo brake.
be expressed as a non-linear function to the external force
                                                                                    B. Braking Torque and Statics of PRP
applied on the wheel in the case that the wheel does not
rotate. We call this the Singular Point of Braking Torque of                           We can express the relation between braking torque (tw =
                                                                                                      T
a passive wheel. In object transportation, there are situations                     [τw1 , τw2 , τw3 ] ) generated by wheels and resultant braking
                                                                                                                                T
that a wheel does not rotate and they usually occur in a                            force and moment r F w = [r fx ,r fy ,r nz ] as follow
very short period. From the Eq.2, we can have the following                                                        tw = J T r F w                          (7)
condition between angular velocity of the wheel and braking
torque of the brake-wheel system.                                                   This static relationship is exactly the same to a system with
                                                                                    active actuators. Based on the wheel arrangement of PRP, J
                                 τw φ̇w ≤ 0                                   (4)   is full rank. However, we have to consider that the passive
   This condition is the servo-brake control constraint to the                      actuators will apply different or opposing output torques
system and indicates that one cannot have arbitrary torque                          to the robot for different motion types. With the possible
from a servo-brake. We need to consider feasible braking                            torques for all motion types, the braking torque set V will
torque in the robot motion control based on this constraint.                        be the same as system with active actuators. This is shown
                                                                                    in Fig.5-(a), as a closed cube in the configuration space of
                  V. M OTION C ONTROL OF PRP
                                                                                    braking torque. 3
A. Kinematics and Motion Type of PRP                                                                  	
                         
                                                                                                V =        τvi ei  |τbi | ≤ τmax             (8)
   The kinematics
                    relation between the motion vector of PRP,
                                                                                                            i=1
q̇ = ẋ, ẏ, θ̇ , and angular velocity vector of wheels, Φ =
                                                                                       However, it does not mean that all torques in this set will
[φw1 , φw2 , φw3 ], can be express as:                                              be feasible by setting proper control input since the robot
                              q̇ = J Φ                       (5)                    motion only belongs to a particular motion type in each
where J,                                                                            moment. The servo-brake control constraint in Eq.4 should
                         ⎡                                        ⎤                 be included in the analysis. Here, we discuss the feasible
                             0          −R
                                         √w
                                           3
                                                      R
                                                      √w
                                                         3
                  J = ⎣ − 2R3w           Rw           Rw          ⎦           (6)   braking torque in each motion type. Uk denotes the set of
                                          3            3
                        − R3Lw          − R3Lw       − R3Lw                         feasible braking torque when PRP robot is in k-th motion
                                                                                    type (k = 1, 2, · · · , 8), and A(Uk ) denotes the resultant force
Rw denotes the radius of the wheel and L denotes the                                and moment on the robot from the braking torque set Uk .
distance between center of the wheel and intersection point                                  	
 3
                                                                                                                                            
of three axes of wheels in the horizontal plane. Robot                                 Uk =       τwi ei  |τwi | ≤ τmax , τwi φ̇wi ≤ 0}           (9)
coordinates are shown in Fig.4. In addition, the Jacobian J                                      i=1
                                                                                                              3
is a full rank matrix. There is a unique mapping relationship                                                	
                           
                                                                                                 A(Uk ) =               τwi v i  τwi ∈ Uk                (10)
between the robot motion and wheel angular velocities.                                                            i=1
   Since the brake torque of each wheel is dependent on the
                                                                                    where 
                        
direction of the wheel rotation, we classify the motion of                                      e1     e2    e3          = diag(1, 1, 1)
PRP into 8 different cases based on the signs of the angular                                
                                −1 
                   
velocities of the three wheels (sgn(φ̇wi ), i ∈ 1, 2, 3).                                       v1 v2 v3                 = JT       e1 e2       e3
                                                                                        k       ∈ 1 ∼ 8 (P RP           M otion Condition Case N umber)
             Table.I M OTION T YPES AND C ONDITIONS OF PRP
                                                                                       Since PRP has eight different motion types, eight sets of
                                 Sign of Angular Velocity of Wheel
                                                                                    Uk exist as the subset of set V and correspondingly, 8 eight
               Wheel 1       +     +     +    +       -       -       -   -         A(Uk ) sets also exist. It is easy to know that V = k=1 Uk .
               Wheel 2       +     +     -       -    +   +           -   -         But we want to note that Uj ∩Uk = 0(j, k = 1, 2, · · · , 8, j =
               Wheel 3       +      -    +       -    +       -       +   -         k) and also A(Uk ) have the same propositions.
         Motion Type No.     1      2    3    4       5   6           7   8            Fig.5-(b,c) show the set of Uk and A(Uk ) respectively
   In each motion type, signs of the angular velocities of the                      when PRP is in Case 1. Uk is a subset of V just in one
three wheels will not change. Therefore, the feasible braking                       quadrant of the braking torque configuration space with six
                                                                                    plane constraints. The three constraint planes connected to
                                                                                    the origin of the coordinates are the braking torque con-
                                                                                    straints. The other three constraint planes are from maximum
                                                                                    torque limitation of each servo-brake. Since the feasible
                                                                                    resultant force and moment set A(Uk ) is the set projected
                                                                                    from Uk , each constraint surface of A(Uk ) set has the same
                                                                                    meaning. Based on the motion which belongs to one motion
                                                                                    type in Case 1∼8, feasible resultant general force (r F w )
                                                                                    and its corresponding braking torque tw could be determined
   Fig.4 .    Configuration and Robot Coordinates of PRP (Top View)                 uniquely.
                                                                               2876
       Authorized licensed use limited to: TOHOKU UNIVERSITY. Downloaded on April 09,2010 at 06:05:01 UTC from IEEE Xplore. Restrictions apply.
                                                                                                                                            ThD4.1
C. Singularity of PRP Braking Torque                                        desired braking torque tw d obtained from inverse dynamics
   Since the omni-directional wheel incorporated in this sys-               of the system. This is the same approach with an active type
tem rotates free on the axis direction of the wheel, v wi , the             robot system.
velocity of wheel i will have two independent components,
velocity on driving direction, v wi drv , and velocity on passive
direction, v wi pas . It is well known that motion of PRP
will have an Instantaneous Center of Rotation, xICOR and
velocity of any point on the robot will be perpendicular
to the line connected to xICOR (Fig.6). According to the
discussion in the previous session, the singular point of
braking torque exists in the case that v wi drv = 0. In the
moment, v wi = v wi pas . Singular point of braking torque is
not unique in this kind of system. Here, let’s denote lsig wi
the set of points that the wheel i is braking singular where
instantaneous center of rotation xICOR is located on. In
PRP (Fig.6-(b)), lsig wi is a line parallel with the rotational
direction of the wheel i, and passing through the intersecting
point of the wheel and wheel axis.
   From this geometric propriety, it is easy to identify the
                                                                             Fig.7 .   Derivation of Feasible Resultant Force and Moment for Control
singular point of the braking torque, and to check the
motion type of PRP when we control a PRP. Also from the                        On the other hand, there are cases in which the desired
geometric analysis, we can understand that there also exists                force and moment r F w d is located outside the feasible set
points that two wheels are in singulars on braking torques                  A(Uk ), and cannot be generated by the passive actuators in
(Fig.6-(c)). In this moment, only braking torque of one wheel               the current type of motion. One typical example is that a
can be controlled on the Eq.2. Other two wheels can not be                  passive type robot cannot generate force to accelerate the
control directly. Torques from those two wheels are governed                object by itself whether it is moving or in halt mode.
by Eq.3. Above discussion on singularity on braking torque                     Because Uk is always in one of the quadrants of the brak-
can be applied to all other type passive robots with different              ing torque space, it is not locally controllable around the ori-
wheel configurations. This makes the method described later                 gin of force and moment space of PRP. However, if there is a
be feasible to other passive mobile platforms.                              proper offset of the force/moment applied to the system, we
                                                                            can have the local controllability around that force/moment.
D. Local Controllability and Motion Control of PRP                          Actually, this proper offset of the force/moment leading
   During object transportation, the force and moment r F w d               default control force/moment into inside of the set Uk is
which should be generated by the robot are determined                       a kind of resistant force/moment to the motion of passive
by the control law applied to the system such as motion                     robot PRP. Then, we can have the local controllability of
control for path tracking and obstacle collision avoidance,                 PRP where the motion of PRP is decelerated if there is no
impedance control, etc. For an active type robot, we just                   any other external force applied to the system.
simply command the motors of the robot to generate torques
for realizing this desired force and moment. However, to a                  E. Impedance-based Motion Control
passive type robot system, the feasible force and moment                       In this study, we consider that a human operator is always
is always dependent on its current motion. We need to                       pushing the object transportation system (Fig.8). This is
examine if the desired force and moment r F w d is in the                   important to us because this could not only let the object
feasible force and moment region in the current motion type,                transportation task be achieved without losing speed, but also
which is determined by the sign of the angular velocities                   guarantee local controllability of PRP system during object
wheels(Fig.7). In the case that it is in the feasible region                transportation, if we design the control algorithm properly.
A(Uk ), we can command the servo-brakes directly with                       In [12], we demonstrated the path following control of PRP
                                                                      2877
      Authorized licensed use limited to: TOHOKU UNIVERSITY. Downloaded on April 09,2010 at 06:05:01 UTC from IEEE Xplore. Restrictions apply.
                                                                                                                                               ThD4.1
                                                                       2878
       Authorized licensed use limited to: TOHOKU UNIVERSITY. Downloaded on April 09,2010 at 06:05:01 UTC from IEEE Xplore. Restrictions apply.
                                                                                                                                                                                                                                                                        ThD4.1
-10 0.15
                  -25                                                                                                      0
                        0       1       2     3   4      5   6     7   8     9 10 11 12 13 14 15                               0       1   2   3   4   5   6    7    8    9 10 11 12 13 14 15
                                                                  time [s]                                                                                     time [s]
                                                         (a)       rf                                                                                           (b)       ry
                                                                           y
                   4.5                                                                                               -40
                                        x position                                                                                                                   actual orientation
                        4                                                                                                                                           desired orientation
3.5 -60
                        3
                                                                                                                                                                                                              (g)                       (h)                       (i)
                                                                                                   orientaion [m]
   position [m]
                                                                                                                     -80
                   2.5
                        2
                                                                                                                    -100
                   1.5
                        1                                                                                           -120
                   0.5
                        0                                                                                           -140
                            0       1     2   3      4   5    6     7 8 9 10 11 12 13 14 15                                0       1       2   3   4   5   6     7 8 9 10 11 12 13 14 15
                                                                  time [s]                                                                                     time [s]
(c) (d) r θ rx
  Fig.11 . Experiment Result of Impedance Based Motion Control: Force in                                                                                                                                      (j)                        (k)                      (l)
  y direction and Trajectory of Position and Orientation                                                                                                                                           Fig.12 . Orientation Control for Passing an Object through a Narrow Place:
                                                                                                                                                                                                   Only the pulling force is applied to the center of the object-robot system.
  the direction perpendicular to the moving direction. When                                                                                                                                        PRPs rotate the object to an orientation cooperatively when they are passing
  the human being pushes PRP (5.5sec ∼ 8.5sec), PRP is                                                                                                                                             the narrow place, and more the object back to the initial orientation finally.
  moving to compliant the push. After the human being stops                                                                                                                                        of assistance force and geometric configuration of passive
  his push (8.5sec), PRP is moving back to its original path.                                                                                                                                      wheels. This is the problem of manipulability of passive type
     In Fig.12, we demonstrate that two PRP robots control the                                                                                                                                     systems with the push of the human operator. Some basic
  object orientation cooperatively so that the object can pass                                                                                                                                     investigations on this issue have been done to our prototype
  through a narrow place. During the demonstration, a human                                                                                                                                        PRP robot. Systematic analysis of manipulability and design
  operator only pulls the PRP-object system by a wire and only                                                                                                                                     of interaction force will be our future works.
  pulling force is applied to the mass center of the object. The
  moment for rotating the object is generated by braking force                                                                                                                                                                 R EFERENCES
  of two PRP robots which incorporating the impedance based                                                                                                                                         [1] K. Kosuge, H. Yoshida, D. Taguchi, and T. Fukuda, “Robot-Human
                                                                                                                                                                                                        Collaboration for New Robotic Application”, IECON94, pp.713-718.
  cooperation strategy we proposed. The object was rotated to                                                                                                                                       [2] O. Khatib, “Mobile manipulation: The robotics assistant”, Robotics
  an orientation (Fig.12-(c)) which can pass the narrow place                                                                                                                                           and Autonomus systems, Vol.26, pp.175-183, 1999.
  and was rotated back to the initial orientation(Fig.12-(l))                                                                                                                                       [3] Z.D. Wang, Y. Hirata, Y. Takano, and K. Kosuge, “From Human to
                                                                                                                                                                                                        Pushing Leader Robot: Leading a Decentralized Multirobot System
  which is perpendicular with the pulling direction.                                                                                                                                                    for Object Handling”, IEEE ROBIO04, pp.441-446, 2004.
                                                                                                                                                                                                    [4] A. Goswami, M.A. Peshkin, and J.E. Colgate, “Passive Robotics: An
                                                                                 VII. C ONCLUSION                                                                                                       Exploration of Mechanical Computation”, ICRA90, pp.279-284, 1990.
                                                                                                                                                                                                    [5] H. Davis and W.J. Book, “Passive Torque Control of a Redundantly
     In this paper, we have presented the concept of object                                                                                                                                             Actuated Manipulator”, ACC97, 1997.
  transportation with a passive type robot system PRP. We                                                                                                                                           [6] M.A. Peshkin, J.E. Colgate, W. Wannasuphoprasit, et al., “Cobot
  have also realized a impedance-based motion control for a                                                                                                                                             control”, IEEE ICRA97, pp.3571-3576, 1997.
                                                                                                                                                                                                    [7] O. Chuy Jr., Y. Hirata, and K. Kosuge, “Augmented Variable Center
  robot system consisting of passive actuators, even the human                                                                                                                                          of Rotation in Controlling a Robotic Walker to Adapt User Charac-
  operator pushes the robot system in only one direction. The                                                                                                                                           teristics”, IEEE/RSJ IROS05, pp.2806-2811, 2005.
  analysis of feasible braking force/moment set, which depends                                                                                                                                      [8] Y. Hirata, A. Hara, and K. Kosuge, “Passive-type Intelligent Walking
                                                                                                                                                                                                        Support System RT-Walker”, IEEE/RSJ IROS04, pp.2289-2294,2004.
  on the motion of the system, and singularity of the system                                                                                                                                        [9] Y. Hirata, A. Hara, and K. Kosuge, “Motion Control of Passive-type
  are provided. A basic strategy for controlling PRP with                                                                                                                                               Walking Support System based on Environment Information”, IEEE
  assistance force from human operator was proposed. Finally,                                                                                                                                           ICRA05, pp.2932-2937, 2005.
                                                                                                                                                                                                   [10] K. Kosuge, Y. Hirata, et al., Motion control of multiple autonomous
  we have demonstrated the concept and control strategy by                                                                                                                                              mobile robots handling a large object in coordination, IEEE ICRA99,
  prototype PRP robots and illustrated the validity of the                                                                                                                                              pp.2666-2673, 1999.
  proposed concept. How large assistance force we need to                                                                                                                                          [11] J.C. Ryu, K.Pathak and S.K.Agrawal, Control of a Passive Mobility
                                                                                                                                                                                                        assistive Robot, ASME IMECE2006-14701, 2006.
  have is depending on two points. One is the magnitude                                                                                                                                            [12] K. Fukaya, Y.Hirata, Z.D. Wang, and K.Kosuge, “Design and Control
  of resultant force that we need to generate for handling                                                                                                                                              of A Passive Mobile Robot System for Object Transportation”, IEEE
  the object. Another one is the relation between direction                                                                                                                                             ICMA06, pp.31-36, 2006.
2879
View publication stats Authorized licensed use limited to: TOHOKU UNIVERSITY. Downloaded on April 09,2010 at 06:05:01 UTC from IEEE Xplore. Restrictions apply.