18
IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution Indirect Feet–Ground Interaction Measurement for Hydraulic-Legged Robots Samir Nabulsi, Javier F. Sarria, Hector Montes, and Manuel A. Armada Abstract—Feet–ground interactions influence the legged robot’s stability. In this paper, a high-resolution indirect force measure- ment for hydraulic-legged robots is presented. The use of pres- sure transducers placed at one or both chambers of the robot’s double-effect hydraulic actuators is investigated, and conclusions are drawn regarding their capability for indirectly measuring the contact forces between the feet and the ground. Because of the nonlinear dynamic properties of hydraulic cylinders, friction modeling is essential to determine at all times the true forces of each foot against the soil. The test case is called ROBOCLIMBER, which is a bulky quadruped climbing and walking machine able to carry heavy-duty drilling equipment for landslide consolidation and monitoring works. Sensor calibration and signal filtering requirements are also taken into consideration. To end, the overall proposed approach to measure feet–ground interactions is experi- mentally evaluated. Index Terms—Feet–ground interactions, friction modeling, hydraulic actuators, pressure sensors, quadruped robot, signal filtering. NOMENCLATURE Notation for hydraulics x p Differential cylinder piston position. φ piston Differential cylinder piston diameter. A A Differential cylinder chamber A area, piston side. φ rod Differential cylinder piston rod diameter. A B Differential cylinder chamber B area, rod side. A p Piston area (used sometimes instead of A A ). V A,B Differential cylinder chamber volumes. α = A B /A A Dimensionless factor relating both chambers. F Force. p A,B Differential cylinder pressure (chamber A, B). k Pressure sensor conversion factor. Notation for the Kalman-based filter (KBF) equations ˆ x k Updated process state vector estimate. P k Error covariance matrix. Manuscript received January 11, 2008; revised July 17, 2008. This work was supported in part by Comunidad de Madrid under Grant RoboCity2030 S-0505/DPI/0176. The ROBOCLIMBER project was funded by the European Commission under Contract G1ST-CT-2002-50160. The Associate Editor co- ordinating the review process for this paper was Dr. Jesús Ureña. The authors are with the Department of Automatic Control, Instituto de Automatica Industrial (IAI-CSIC), 28500 Madrid, Spain (e-mail: snabulsa@ iai.csic.es; [email protected]; [email protected]; [email protected]). Color versions of one or more of the figures in this paper are available online at http://ieeexplore.ieee.org. Digital Object Identifier 10.1109/TIM.2009.2017650 K k Kalman gain (blending factor). H Matrix giving the ideal (noiseless) connection between the measurement and the state vector. Q k Covariance matrix. R k Variance matrix. e k Prior covariance error. u k Vector assumed to be a white sequence with known covariance structure. Φ State transition matrix. I. I NTRODUCTION R ESEARCH on walking and climbing robots has received great attention during the last decade [1]–[4], and a broad spectrum of applications have been reported in the literature, which range from shipbuilding [5], [6] and construction indus- try [7] to many others [8], [9]. Moreover, future applications of service robots entail in a relevant manner the development of climbing and walking machines [10], [11]. In particular, climb- ing robots could provide construction industries with useful tools to decrease human exposition to harmful working con- ditions and to increase productivity [12]. Rocky slope consoli- dation to avoid landslides is required before undertaking other infrastructure works (e.g., road, rail, and buildings). However, the current practice for slope consolidation involves dangerous labor-intensive operations based on deep drilling using heavy- duty machinery to get holes at geologically selected locations in the slope. Such holes (up to 20 m in depth) are filled in with con- crete, which reinforces the slope and, therefore, consolidates it and avoids landslides. Steel networks are then put in place to finish the work [12]. ROBOCLIMBER (Fig. 1) is a quadruped walking and climbing robot whose development was funded by the European Commission under a Cooperative Research Program with the objective to develop a teleoperated service robotic system that could safely perform slope monitoring and consolidation tasks [13], [14]. The robot is based on a mechanical structure [15] that is supported by four legs, where each leg provides three degrees of freedom in a cylindrical kinematic configuration (Fig. 2). Each of the legs is able to support a total load of more than 15 000 N, and they are all able to carry the drilling unit and other auxiliary equipment onboard, which lead to an overall weight of 4 tons. ROBOCLIMBER (a good report was released by Discovery Channel [16]) can work by walking and even climbing uneven mountain slopes with inclination ranging from 30 to almost 90 , and in this case, it is being held from the top of the moun- tain by two steel ropes, each of which is anchored to a certain 0018-9456/$26.00 © 2009 IEEE

IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

  • Upload
    others

  • View
    13

  • Download
    0

Embed Size (px)

Citation preview

Page 1: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1

High-Resolution Indirect Feet–Ground InteractionMeasurement for Hydraulic-Legged Robots

Samir Nabulsi, Javier F. Sarria, Hector Montes, and Manuel A. Armada

Abstract—Feet–ground interactions influence the legged robot’sstability. In this paper, a high-resolution indirect force measure-ment for hydraulic-legged robots is presented. The use of pres-sure transducers placed at one or both chambers of the robot’sdouble-effect hydraulic actuators is investigated, and conclusionsare drawn regarding their capability for indirectly measuringthe contact forces between the feet and the ground. Because ofthe nonlinear dynamic properties of hydraulic cylinders, frictionmodeling is essential to determine at all times the true forces ofeach foot against the soil. The test case is called ROBOCLIMBER,which is a bulky quadruped climbing and walking machine ableto carry heavy-duty drilling equipment for landslide consolidationand monitoring works. Sensor calibration and signal filteringrequirements are also taken into consideration. To end, the overallproposed approach to measure feet–ground interactions is experi-mentally evaluated.

Index Terms—Feet–ground interactions, friction modeling,hydraulic actuators, pressure sensors, quadruped robot, signalfiltering.

NOMENCLATURE

Notation for hydraulics

xp Differential cylinder piston position.φpiston Differential cylinder piston diameter.AA Differential cylinder chamber A area, piston

side.φrod Differential cylinder piston rod diameter.AB Differential cylinder chamber B area, rod side.Ap Piston area (used sometimes instead of AA).VA,B Differential cylinder chamber volumes.α = AB/AA Dimensionless factor relating both chambers.F Force.pA,B Differential cylinder pressure (chamber A, B).k Pressure sensor conversion factor.

Notation for the Kalman-based filter (KBF) equations

xk Updated process state vector estimate.Pk Error covariance matrix.

Manuscript received January 11, 2008; revised July 17, 2008. This workwas supported in part by Comunidad de Madrid under Grant RoboCity2030S-0505/DPI/0176. The ROBOCLIMBER project was funded by the EuropeanCommission under Contract G1ST-CT-2002-50160. The Associate Editor co-ordinating the review process for this paper was Dr. Jesús Ureña.

The authors are with the Department of Automatic Control, Instituto deAutomatica Industrial (IAI-CSIC), 28500 Madrid, Spain (e-mail: [email protected]; [email protected]; [email protected]; [email protected]).

Color versions of one or more of the figures in this paper are available onlineat http://ieeexplore.ieee.org.

Digital Object Identifier 10.1109/TIM.2009.2017650

Kk Kalman gain (blending factor).H Matrix giving the ideal (noiseless) connection between

the measurement and the state vector.Qk Covariance matrix.Rk Variance matrix.ek Prior covariance error.uk Vector assumed to be a white sequence with known

covariance structure.Φ State transition matrix.

I. INTRODUCTION

R ESEARCH on walking and climbing robots has receivedgreat attention during the last decade [1]–[4], and a broad

spectrum of applications have been reported in the literature,which range from shipbuilding [5], [6] and construction indus-try [7] to many others [8], [9]. Moreover, future applications ofservice robots entail in a relevant manner the development ofclimbing and walking machines [10], [11]. In particular, climb-ing robots could provide construction industries with usefultools to decrease human exposition to harmful working con-ditions and to increase productivity [12]. Rocky slope consoli-dation to avoid landslides is required before undertaking otherinfrastructure works (e.g., road, rail, and buildings). However,the current practice for slope consolidation involves dangerouslabor-intensive operations based on deep drilling using heavy-duty machinery to get holes at geologically selected locations inthe slope. Such holes (up to 20 m in depth) are filled in with con-crete, which reinforces the slope and, therefore, consolidates itand avoids landslides. Steel networks are then put in place tofinish the work [12]. ROBOCLIMBER (Fig. 1) is a quadrupedwalking and climbing robot whose development was fundedby the European Commission under a Cooperative ResearchProgram with the objective to develop a teleoperated servicerobotic system that could safely perform slope monitoring andconsolidation tasks [13], [14].

The robot is based on a mechanical structure [15] that issupported by four legs, where each leg provides three degrees offreedom in a cylindrical kinematic configuration (Fig. 2). Eachof the legs is able to support a total load of more than 15 000 N,and they are all able to carry the drilling unit and other auxiliaryequipment onboard, which lead to an overall weight of 4 tons.ROBOCLIMBER (a good report was released by DiscoveryChannel [16]) can work by walking and even climbing unevenmountain slopes with inclination ranging from 30◦ to almost90◦, and in this case, it is being held from the top of the moun-tain by two steel ropes, each of which is anchored to a certain

0018-9456/$26.00 © 2009 IEEE

Page 2: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

2 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 1. ROBOCLIMBER field tests (Alps, North Italy). Robot climbing isbeing performed with the help of cable traction devices.

Fig. 2. ROBOCLIMBER basic configuration: body platform and four legs.

distance from the other. The robot is equipped in its front sidewith two hydraulically operated traction devices that are usedfor grasping and pulling each steel rope, which leaves one endof the steel cable free (Fig. 1). The robot’s body displacementand the traction device pulling force must simultaneously becontrolled for proper climbing [17]. To develop a compact andreliable control system that is capable of running a large robotwith high reasonable safety, a suitable solution was to usedouble-effect (differential) hydraulically powered cylinders inall robot joints as actuators, which are controlled by means ofproportional valves. The hydraulic power unit (16 kW), drillingequipment, cable-pulling units, and control system are carriedon the robot (Fig. 1), and the robot is supervised from a remotelocation with no need of operators onboard [18].

II. INTEREST OF FEET–GROUND

INTERACTION MEASUREMENT

Legged robot displacement is obtained through the alterna-tion of the legs’ movements according to explicitly definedsequences [19]–[21]. Such gaits have implicit foot lift and downactions that result in alternating foot–ground contacts. The firstrequirement for a proper legged robot performance is stability.

Walking or climbing over flat surfaces could be achieved byusing appropriated gaits, but even in this ideal case, and mostlydue to robot mechanical imperfections, the robot’s movementsresult (generally after a short number of cycles) in loosing therobot’s attitude and instability [19].

To solve this problem, legged robots are equipped with somekind of on–off contact sensors at their feet, and using thissimple information, it is possible for the robot to walk and climbover uneven surfaces by stopping the leg when the foot contactsground or leaving it to go further the theoretical trajectory setpoint until contact is detected. However, this solution is notperfect, and there are many practical situations [e.g., due to achange in the working conditions (load and posture)] where thisapproach is not enough. A significant case is when perforationrods are being drilled into the mountain slope. Their weightaccounts to one-third of the robot weight, so this very muchaffects the payload distribution. Moreover, reaction forces inthe orthogonal direction to the slope are expected to change ina difficult-to-predict manner during drilling (involving hitting)and all through removing the drilling rods from the rocky slope.This will result in uncontrolled feet–ground contact loosing,which translates into undesirable robot vibrations. Moreover,the uneven surface requires using the third joints (vertical) ofthe legs to adjust and control the drilling unit orientation tobe as close as possible to 90◦ against the slope. Moreover,a robot of ROBOCLIMBER proportions could be useful formany other applications (apart from drilling), for example, inthe exploration or transport of equipment through hazardousareas. This yields to changing the total mass of the robot andto changes in their center of gravity, which lead to gait stabilityproblems. Therefore, it is required to propose other methods toovercome the problem.

One possible solution is to consider feet–ground contactforce measurement, where we feedback this measurement in-formation into the robot control system [20] to implementcontrol strategies to solve the aforementioned problems. Forexample, one of the most important applications could becontrolling the overall force distribution, which will allowcontrolling the momentum about the robot axis; this being veryimportant both for walking on uneven terrain and particularlyfor climbing on rough slopes [19]–[21]. Therefore, the firstmatter is to use vertical joints with force-sensing capability.Furthermore, because of the wide range of possible workingsituations for ROBOCLIMBER [21], force measurement in theother two joints has also been under consideration with the goalof controlling the overall force distribution and allowing theimplementation of force control algorithms for controlling therobot–environment interaction [22], [23].

III. INDIRECT FEET–GROUND INTERACTION

MEASUREMENT USING PRESSURE SENSORS

The ROBOCLIMBER control system employs position feed-back that is provided by 12 high-resolution encoders to measureprismatic joint excursions (joints 2 and 3 of each leg: 0.1-mmresolution) and rotation angle (joint 1 of each leg: 10 000 countsper revolution) to control with high accuracy the robot move-ments using 12 digital PID controllers tuned (independently)

Page 3: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 3

Fig. 3. ROBOCLIMBER’s vertical link of one leg made of steel subassem-blies with hydraulic cylinder inside.

for each joint [18]. The output of the position PID controllers(a pulse width modulation (PWM) signal) is converted to ananalog signal and fed to another set of 12 power servoamplifiersthat process these signals through another PID compensator thatprovides PWM signals to control the proportional valves (aninternal current feedback loop is used to smooth the intensity tothe solenoids). Proportional valves provide controlled oil flowinto the differential hydraulic cylinders (oil ports A and B),which results in piston positioning. Fig. 3 shows a diagram ofthe ROBOCLIMBER’s vertical link of one leg, which is madeof steel subassemblies with the hydraulic cylinder inside. Itconsists of two frames that slide against the other. The pistonrod has attached at its free end one foot that contacts the ground.

As previously explained, we are first interested in the mea-surement forces along the robot z-axis. One possible solutionhas stemmed after analyzing the force analysis acting on theleg foot (Fig. 3) [22], [23]. It can be inferred from this analysisthat the extension of the prismatic joint is made by the hy-draulic pressure inside the cylinder’s chamber, and therefore,this hydraulic pressure is the pressure that supports the weightof the robot. Therefore, a method to obtain information aboutcontact forces is to use pressure sensors placed at one orboth ends of the chambers (oil ports A and B, Fig. 3) of thedifferential cylinders and to obtain an indirect estimation of thecontact forces. The transducers usually employed to convertthe hydraulic pressure into electrical signals are the so-calledpressure transducers. The main advantage of these kinds oftransducers is that they are low cost, easy to install, reliable, andprovide good precision, but, of course, the different propertiesof the overall hydraulic system behavior should be taken into

TABLE IROBOCLIMBER TECHNICAL DATA

account [24]–[29]. Table I shows some technical data of theROBOCLIMBER. The next sections discuss the use of sensorsin one or two of the oil ports.

A. Force Measurement Using Pressure Information FromOne Chamber

For our application, hydraulic GEMS 2200 pressure sensorswith an operating pressure range between 0 and 100 bar,providing a signal from 0 to 5 V, and with 0.25% precisionand thermal error of 1.25% (full scale) were selected. The firstapproximation consisted of the measurement of the force FA

supported by the upper chamber of the hydraulic cylinder foreach leg (Fig. 3) using only one transducer at oil port A andmeasuring the force according to

FpA = pA · AA (1)

where AA is the piston area (Table I), and pA is the pressuremeasured with the sensor just placed at oil port A. With the se-lected sensor, it is then possible to have a theoretical sensitivityof 96 N.

The pressure sensor output signal is processed by a modularinstrumentation amplifier that combines high accuracy, lownoise, high-precision gain, high linearity, and temperature com-pensation. Because the leg manufacturing process is not ideal,a tuning process has to be done on the amplifiers for all legs toperceive with high-resolution interaction forces independent ofmechanical differences. The purpose of the tuning process is tofind the relationship between the output signal of the amplifier(Vout) and the pressure (p), which aims to adjust dc bias,amplifier gain, and bandwidth. The tuning method consistedof using one leg at a time, which leaves the others raised (noground contact). Then, the subject leg is vertically moved withthe foot contacting a calibrated reference load cell (maximumpayload of 30 000 N, 10-N precision, and 1.7 N of standarddeviation), and using (1), the force measurements provided bythe load cell are converted to pressure. This tuning has theadvantage (and the goal) of compensating, in some way, theinherent inaccuracies of using pressure measurement in onlyone chamber to simplify the sensor setup (and to decrease cost).The values of each of the devices were gathered in real time.Given the pressure equation [where k is the pressure conversionfactor (20 × 105 N/(m2 × V)], we have

p = k(aVout + b). (2)

Page 4: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

4 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 4. Chamber A pressure sensor tuning.

TABLE IICALIBRATION VALUES FOR THE PRESSURE EQUATION

A linear regression was done with the Matlab Curve FittingTool using the data obtained during the tuning process. Theresult is graphically shown in Fig. 4, and the a and b parametersfor each leg are listed in Table II.

To evaluate and eventually better understand the possiblelimitations of using only one pressure sensor, several exper-iments were conducted. The robot was equipped with foursensors at oil port A of the vertical joints. The first experimentconsisted of raising the robot on four legs under velocity controland in several steps from its rest position (robot body framecontacting ground, feet up), to several new positions, stoppingsome time at each one, and proceeding to the next. The resultsare shown in Fig. 5.

The first thing to notice is that the control system perfectlykeeps each vertical joint position, but there is a clear force decaythat is motivated by a pressure decay inside chamber A, andas a consequence, the apparent weight of the overall machineis decreasing very slowly with time in a significant amountand converging slowly to a stationary value that matches theactual machine weight. While this could be useful in otherapplications, however, for our control purposes of fast detectionand proper control of contact forces, it cannot be accepted.

The main reason for this situation resides in the nature ofthe hydraulic circuit and its components. Capacitive effects andnonlinearities [26], [27] are the most likely reasons for thatsituation.

The next experiment consisted of an evaluation of the dy-namic behavior of the proposed measurement system. The sim-plest possible test was to measure the given force while movinga vertical joint according to a sinusoidal wave function (for thespeed) (Fig. 6) with no additional payload, i.e., the foot is notcontacting ground, and so force is employed to overcome the in-

ternal sliding leg frame weight of the leg and friction. In all theexperiments shown in this paper, the oil temperature was low.

As a result of the experiment, it is possible to notice thatthe behavior is as expected, which means that the joint’s forcecalculated using (1) is actuating according to the accelerationof the movement. However, as can be noticed in Fig. 6, forcemeasurement attains peak values of about 2100 N, whereas intheory, if the joint is actuating without any external payload,then the joint should not be measuring any additional load apartfrom their internal frame (which accounts for 900 N). One ofthe main reasons of having about 2100-N force measurementwithout additional payload could be friction, but it is mostlikely also because measurement at only oil port A is notenough for our application (it is of course very valid for manyother practical cases [26], [27]), and we foresee the need totake into account what happens inside chamber B. Addition-ally, other phenomena due to pressure distribution across thehydraulic circuit could be taken into account. To overcomethose inconvenient situations, which are noticeable from theobtained results, the use of differential pressure measurementis proposed in the next section. In addition, friction modelingwill be accomplished in the subsequent section.

B. Force Measurement Using Pressure Information FromTwo Chambers

One way to minimize the effects of pressure variations insidethe hydraulic circuit is to measure the differential pressurebetween both chambers [26], [27]. The method consists ofmeasuring the pressure acting on the piston by adding a secondsensor at actuator input B to measure the differential pressurethat exists between chambers A and B, and, as consequence, tomeasure the static force that the rod is exerting in the verticaldirection (Fz) by using the following equation:

Fz = Fp(pA, pB) = FpA − FpB = (pA − αpB)Ap. (3)

Ap is the area of the piston, and α is the differential factorbetween both chambers [27] (please refer to Table I for actualparameter values). The sensor at oil port B is connected tothe port through a rigid pipe at about 0.7 m from the port.Connections from both sensors to the hydraulic power unit areby means of a combination of flexible hoses and rigid pipes.The length of such a hydraulic circuit is several meters.

To notice the effect in force measurement using the pressuredifference from both sides of the piston, the cylinder wassubject to a sinusoidal reference input in speed. In this case,the effects introduced by acceleration are liberalized, but thisdoes not happen with friction effects, as can be noticed in therecorded graphic (Fig. 7). This experiment was realized in thesame conditions like the previous experiment, and it is possibleto notice that both leg speed and force at chamber A are thesame (Fig. 6). In addition, it is interesting to point out that theresulting force values are actually more clearly connected withthe inner load in movement. The negative sign for resultantforces in Fig. 7 needs to be interpreted just as a conventionto indicate the direction of movement (force projection againstrobot reference frame).

Page 5: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 5

Fig. 5. Force measurement at vertical joints using only one pressure sensor at each oil port A of the robot actuators (horizontal axis means time in seconds).

Fig. 6. Force measurement using sensor at chamber A of a vertical joint.

Fig. 7. Differential force measured using pressure sensors at both oil ports ofthe hydraulic cylinder.

As a conclusion, the force Fp computed using the pressuredifference signal is well suited to measure the “true” contactforce and should be preferred to the use of only one transducerat chamber A or B. The use of two transducers also hasadditional advantages.

1) Temperature effects are minimized when friction mea-surements are used. Temperature variations dramaticallychange the oil viscosity, but differential measurementminimizes that effect.

2) Low-velocity measurements are now more reliable andaccurate (under 5 mm/s), whereas with only one chambermeasurement, speed measurement is always problematic.This is very important, for example, when implementingforce control strategies.

3) In addition, as a third advantage, this approach doesnot require perfect parameterization of friction, whichsimplifies the computation.

IV. FRICTION MODELING

As it is well known, one of the main nonlinearities of thecylinder model is nonlinear friction [27]–[29]. To understandthe influence of friction in the overall response of the cylinders,a standard method to counteract the influence of friction againstthe measurement of the differential pressure on the hydraulicfluid is to measure the force actuating in the joint without theinfluence of any external load during the displacement with acertain velocity xp according to the Stribeck model [26]–[28]

Ff (xp) = Fv(xp) + Fc(xp) + Fs(xp)

= σxp + sign(xp)[Fc0 + Fs0 exp

(−|xp|

cs

)]. (4)

In (3), the friction force is made up of three different partswith the following meaning:

Fv viscous friction;σ parameter for viscous friction;Fc Coulomb friction;

Page 6: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

6 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 8. Results of friction modeling experiments for vertical links.

Fc0 parameter for the Coulomb friction;Fs static friction;Fs0 parameter for the static friction;cs parameter for the static friction, known as the Stribeck

velocity.To take into account the differential cylinder asymmetry, it is

convenient to use a modification of (4) as follows:

Ff (xp)

=

⎧⎨⎩

σ+xp + sign(xp)[F+

c0 + F+s0 exp

(−|xp|

c+s

)]∀xp ≥ 0

σ−xp + sign(xp)[F−

c0 + F−s0 exp

(−|xp|

c−s

)]∀xp < 0.

(5)

It is possible to experimentally identify friction parametersby finding the relationship between the velocity of the jointand the measured force. Usually, this identification must bedone without any additional payload and in horizontal position(without the influence of gravity), and in this case, it is possibleto easily find the parameters associated with friction [27]. How-ever, in our case, the friction modeling process has been doneby leaving the vertical joint in its regular position without beinguninstalled from the robot structure, where it is possible tomodel the effects of the mechanical structure of the joints, likethe weight of the inner joint bodies, the structural mechanicalfriction of the prismatic joint, and the gravity effects. Aiming tothat purpose, for the model identification of one of the verticaljoints, the cylinder has been actuated in different positive andnegative velocities, without touching the ground with the foot,while the forces were measured.

Fig. 8 shows the results of the experimental modeling of theactuator friction, and it is possible to notice that for each ofthe velocities in which the force (differential pressure) has beenmeasured, the force is not around a certain point but among awide set of measurements. This is because the friction forcenot only changes according to the velocity but according to theextension of the hydraulic cylinder (it depends on its position;this theoretical assumption [27], [28] is well corroborated hereby experimentation), where there is a difference among thefluids in each chamber at each instant.

TABLE IIISTRIBECK FRICTION PARAMETERS FOR PRISMATIC VERTICAL JOINT

Table III shows the obtained Stribeck parameters for thisexperiment. These parameters were found out by an approxima-tion process (parameter tuning was done using simple identifi-cation algorithm [27], [28]), which defined the Stribeck-basedbehavior of the friction for a certain vertical prismatic joint.

The resulting function is like a typical Stribeck model, butwith a few differences. The most important difference is thatthe slope of the friction according to the viscous behavior ineach sign of the velocity is different from each other. This isbecause of the vertical position of the prismatic joint, where itis necessary to support its own inner weight while it is moving.In conclusion, it has been shown that a good modeling of fric-tion has been accomplished through extensive experimentation.This work has been done for all robot joints.

In addition to the effects described before, there are dif-ferent phenomena (e.g., fluid compression, stick-slip effect,etc.), other than the implicit signal noise, that influence thehydraulic system dynamics. Using the experimental setup withROBOCLIMBER, some of these effects have been studied(Fig. 9). Although they do not necessarily have to be takeninto account for a hypothetical force control system, they areof interest to better understand the actuator behavior.

V. SIGNAL FILTERING

For reactive control purposes, it is needed to handle signalsthat could provide accurate and reliable force measurementwith high resolution. This obviously implies signal filtering.Being the previous sections devoted to understand and to modelthe hydraulics, and to investigate the best way to obtain precisemeasurements of feet–ground interactions, some considerationson filtering for this application are herein presented. After hav-ing good experimental information about the involved signalsin our problem, some first- and second-order digital filtershave been tested; even different types of Kalman filters havebeen tested too. However, after preliminary trials, it has beendecided to use a modified KBF [30], [31] to improve the qualityof the force measurements based on the hydraulic pressure.This modified KBF (Fig. 10) is a digital recursive solution forreal-time applications [31]. The process [Fig. 10, (1)] startsby giving a prior estimation of the process state vector xk−1,the error covariance Pk−1, and the maximum threshold emaxdetermined for our system. It is assumed that at this point, it is intime tk, and that this prior estimate is based on our knowledgeof the process before tk.

The next problem is to find the particular blending factor Kk

[Fig. 10, (2)] that yields an update estimate that is optimal insome sense. This estimation can be controlled by the varianceR, which in our case can be assumed constant and was experi-mentally obtained.

Page 7: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 7

Fig. 9. Example of force signal obtained using differential pressure mea-surements and identification of fluid compression and stick-slip phenomena(horizontal axis means time in seconds, vertical scale means force in newtons).

Fig. 10. Modified KBF loop.

With the assumption of a prior estimate xk−1, it is necessaryto use the actual measurement zk to improve the prior estimatexk−1 (4). However, the different types of effects actuating in thehydraulic circuit can degenerate this estimation because mostof these effects cause high pecks in zk. Therefore, to improvethe measurement by taking into account the external effects,additional control estimation has been added to improve the

robustness of the filter where xk would not be updated if thecovariance error ek overpasses emax [Fig. 10, (3)], where

ek = zk − xk−1. (6)

The next step is to evaluate the error covariance vector Pk

associated with the updated estimate [Fig. 10, (5)]. Finally, theprocess must update the future state vector xk+1 and covariancevector Pk+1 [Fig. 10, (6)], which is evaluated with a constantcovariance matrix Qk (which, in this case, is also assumedconstant and experimentally determined).

The significant effectiveness of the filter can be changed bymodifying the R and Qk values. If R is increased, then themeasurements prior to tk will have more influence over xk, andif Qk increases, then the influence of the actual measurementwill increase too. For the experimental results presented inthe next section, R and Qk values were determined throughmany trial-and-error testing. This was enough for our presentpurposes.

VI. EXPERIMENTAL RESULTS

This section is devoted to a final experimental verificationof the proposed methodology. To do that, the experiment willconsist of trying to obtain a signal that only represents theactual force acting on the system (one actuator), which filtersout undesirable dynamic effects. Moreover, it will be shown thatan additional KBF provides definitive results.

A. Friction Modeling

It is possible to measure the force acting on the cylinderwithout the dynamic effects by only measuring the externalpayload using the following equation, where nonlinear frictionis introduced [27], [28]:

F ext(pA,pB, xp) = F p(pA,pB) − F f . (7)

To verify the result of using the Stribeck-model-based func-tion, the same example of the sinusoidal movement of the joint(please refer to Fig. 7) has been used, subtracting from thedifferential force signal the friction-based Stribeck model.

As it is possible to notice from the force behavior (seeFig. 11), the results form the external forces measured fromthe differential forces, and the friction parameterization of thevertical joint are very acceptable, where the forces of the jointare around zero when there is no external payload acting.

However, there are still some high and low peaks. Thesepeaks are the result of the behavior of the hydraulic systemwhen the cylinder is actuating at low velocities, where it is verydifficult to model the system [26].

B. Signal Filtering

As explained before, a suitable way to take advantage ofthe KBF to filter complex signals is to add a threshold inthe covariance error ek. The problem is that in the hydraulicsystem, there are many external effects that are exhibited in thepressure, and in consequence, in force evaluation. Most of theseeffects are shown in the form of high peaks.

Page 8: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

8 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 11. Illustration of the use of friction modeling.

Fig. 12. Illustration of filtering approaches applied to force measurements.

TABLE IVPARAMETERS FOR THE FILTERING PROCESS

As an example, Fig. 12 presents a graphic that shows thedifference between a filtered signal with a discrete KBF andthe signal filtered with the proposed modified KBF and itsRk parameters Qk, and the maximum threshold in the secondcase emax (Table IV). As it is possible to notice, with themodified KBF, the filtered signal follows the same tendency ofthe original signal, but avoiding the dynamic effects of the lowvelocities in the hydraulic actuator.

VII. CONCLUSION

Force measurement is a very important issue in the devel-opment process of a semiautonomous walking robot for the im-provement of its robustness. ROBOCLIMBER is a heavyweight

quadruped robot designed for performing complex operationsover natural terrain, where it is necessary to use robust andreliable sensor systems.

Instead of creating or installing any external force sensor,a proper solution is to use the hydraulic system properties tocompute the force generated by the joints of the system. Thisforce is evaluated by measuring the pressure in the hydraulicflow of the joints’ oil ports of actuators. The hydraulic pressuretransducers are well known in the market, relatively cheap, andeasy to adapt in the hydraulic circuit.

However, the problem is that when the pressure in the hy-draulic system is measured, not only the dynamic effects of thehydraulic components affect the system, but also any unknownbehavior of the complete system is intrinsically incorporatedand so measured in the pressure signal.

That is why it is so important to understand the hydraulicsystem behavior and the most important effects that can origi-nate alterations in the system. In this paper, some of the mostimportant effects associated with the practical use of hydraulicactuators have been studied, which are mostly concentratedin the vertical links of the ROBOCLIMBER whose free endsare the feet that interact with the ground. It has been shownhow proper friction modeling is required, because it greatlyinfluences the system response. The method used to model thefriction in the vertical joint is also applicable to the other jointsof the system, although that has been omitted here for brevity.Another important issue was to investigate the use of one or twopressure sensors. For accurate and dynamically representativeforce measurements, it can be concluded that the use of twosensors is the only choice for our application.

To improve the precision and reliability of the signals pro-vided by the friction model, and after many digital filter analy-sis, for this application, the use of the modified KBF has beenproposed.

With those results, it can also be concluded that, forhydraulic-legged robots, the indirect force computed with theproposed methodology presents significant advantages in termsof accuracy, reliability, simplicity, and low cost when comparedwith previous approaches of direct force measurement usingload cells [21], [22].

ACKNOWLEDGMENT

The authors would like to thank Dr. R. Caballero fromPanama Technical University for his kind help regardingKalman filtering. This paper is an extended version of [24]presented at the IEEE International Workshop on IntelligentSignal Processing (WISP) 2007.

REFERENCES

[1] P. González de Santos, M. Armada, A. Martin, and W. de Peuter, “Asurvey of locomotion concepts for planetary exploration rovers,” inProc. 3rd ESA Workshop Adv. Space Technol. Robot Appl., Noordwjck,The Netherlands, 1994.

[2] M. Armada and P. González de Santos, “Climbing, walking and inter-vention robots,” Ind. Robot—An International Journal, vol. 24, no. 2,pp. 158–163, 1997.

Page 9: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 9

[3] M. Armada, “Climbing and walking: From research to applications,”in Proc. 3rd Int. Conf. Climbing Walking Robots, Madrid, Spain, 2000,pp. 39–48.

[4] G. S. Virk, G. Muscato, A. Semerano, M. Armada, and H. A. Warren,“The CLAWAR project on mobile robotics,” Ind. Robot—An Interna-tional Journal, vol. 31, no. 2, pp. 130–138, 2004.

[5] P. González de Santos, M. Armada, and M. A. Jiménez, “Ship buildingwith ROWER,” IEEE Robot. Autom. Mag., vol. 7, no. 4, pp. 35–43,Dec. 2000.

[6] J. C. Grieco, M. Prieto, M. Armada, and P. González de Santos, “Asix-legged climbing robot for high payloads,” in Proc. IEEE Int. Conf.Control Appl., Trieste, Italy, 1998, pp. 446–450.

[7] M. Armada and P. González de Santos, “Perspectives of climbing andwalking robots for the construction industry,” in Proc. 4th Int. Conf.Climbing Walking Robots, Paris, France, 2001, pp. 929–936.

[8] M. Armada, P. González de Santos, M. A. Jiménez, and M. Prieto, “Ap-plication of CLAWAR machines,” Int. J. Robot. Res., vol. 22, no. 3/4,pp. 251–264, 2003.

[9] Balaguer, G. S. Virk, and M. Armada, “Robot applications againstgravity,” IEEE Robot. Autom. Mag., vol. 13, no. 1, pp. 5–6, Mar. 2006.

[10] M. Armada, “Robotics: Now and beyond,” Ind. Robot—An InternationalJournal, vol. 32, no. 2, p. 97, Apr. 2005.

[11] E. Garcia, M. A. Jiménez, P. González de Santos, and M. Armada, “Theevolution of robotics research,” IEEE Robot. Autom. Mag., vol. 14, no. 1,pp. 90–103, Mar. 2007.

[12] M. Armada and R. M. Molfino, “Improving working conditions andsafety for landslide consolidation and monitoring,” in Workshop RoleCLAWAR Educ., Training, Working Conditions Safety, Madrid, Spain,2002.

[13] P. Anthoine, M. Armada, S. Carosio, P. Comacchio, F. Cepolina,P. González, T. Klopf, F. Martin, R. C. Michelini, R. M. Molfino,S. Nabulsi, R. P. Razzoli, E. Rizzi, L. Steinicke, R. Zannini, andM. Zoppi, “ROBOCLIMBER,” in 1st Int. Workshop ASER, Bardolino,Italy, Mar. 13–15, 2003.

[14] P. Anthoine, M. Armada, S. Carosio, P. Comacchio, F. Cepolina,P. González, T. Klopf, F. Martin, R. C. Michelini, R. M. Molfino,S. Nabulsi, R. P. Razzoli, E. Rizzi, L. Steinicke, R. Zannini, andM. Zoppi, “ROBOCLIMBER: A four-legged climbing robot for rockyslope consolidation and monitoring,” in 10th ISORA, Seville, Spain, 2004.

[15] R. Molfino, M. Armada, F. Cepolina, and M. Zoppi, “ROBOCLIMBERthe 3 ton spider,” Ind. Robot—An International Journal, vol. 32, no. 2,pp. 163–170, 2005.

[16] Roboclimber Project. [Online]. Available: http://www.iai.csic.es/dca/dac_Robots.html

[17] S. Nabulsi and M. Armada, “Climbing strategies for remotemaneuverability of ROBOCLIMBER,” in 35th ISR, Paris, France,2004.

[18] S. Nabulsi, M. Armada, and P. González de Santos, “Control architecturefor a four-legged hydraulically actuated robot,” in Proc. ISMCR, Madrid,Spain, 2003, pp. 291–295.

[19] P. González de Santos and M. A. Jiménez, “Generation of discontinuousgaits for quadruped walking vehicles,” J. Robot. Syst., vol. 12, no. 9,pp. 599–611, 1995.

[20] S. Hirose and Y. Kuneida, “Generalized standard foot trajectory for aquadruped walking vehicle,” Int. J. Robot. Res., vol. 10, no. 1, pp. 3–12,Feb. 1991.

[21] M. Prieto, M. Armada, and S. Ros, “Continuous climbing control for thelegged robot REST-2,” in 3rd Int. Conf. CLAWAR, Madrid, Spain, 2000,pp. 491–498.

[22] H. Montes, S. Nabulsi, and M. Armada, “Design and implementationof force sensor for roboclimber,” in Proc. Int. Conf. CLAWAR, Madrid,Spain, 2004, pp. 219–228.

[23] H. Montes, S. Nabulsi, and M. Armada, “Reliable, built-in, high-accuracyforce sensing strategies in walking robots,” Int. J. Robot. Res., vol. 25,no. 9, pp. 931–950, Sep. 2006.

[24] S. Nabulsi, J. F. Sarria, and M. Armada, “Indirect force measurementfor hydraulic walking robot,” in Proc. IEEE Int. Symp. WISP, Alcala deHenares, Spain, 2007, pp. 753–757.

[25] H. E. Merrit, Hydraulic Control Systems. New York: Wiley, 1967.[26] T. J. Viersma, Analysis, Synthesis and Design of Hydraulic Servosystems

and Pipelines. Amsterdam, The Netherlands: Elsevier, 1980.[27] M. Jelali and A. Kroll, Hydraulic Servo-Systems: Modelling, Identifica-

tion and Control. Berlin, Germany: Springer-Verlag, 2003.[28] B. Armstrong-Helouvry, P. Dupont, and C. Canudas de Wit, “A survey

of models, analysis tools and compensation methods for the control ofmachines with friction,” Automatica, vol. 30, no. 7, pp. 1083–1138,Jul. 1994.

[29] J. Polzer and D. Nissing, “Mechatronic design using flatness based controlto compensate for a lack of sensors,” in Proc. Mechatronics, Darmstadt,Germany, 2000.

[30] R. Brown and P. Hwang, Introduction to Random Signals and AppliedKalman Filtering. New York: Wiley, 1985.

[31] G. Welck and G. Bishop, “An introduction to the Kalman filter,” Univ.North Carolina, Chapel Hill, NC, TR 95-041, Jul. 24, 2006.

Samir Nabulsi received the M.Sc. degree from thePolytechnic University of Madrid, Madrid, Spain, in2007 and the Ph.D. degree from the ComplutenseUniversity of Madrid, Madrid, in 2008.

He is currently with the Department of Auto-matic Control, Instituto de Automatica Industrial(IAI-CSIC), Madrid. He is specialized in the me-chanical design and control of legged robots. Hehas been working in the ROBOCLIMBER projectand in several other European-Commission-fundedprojects.

Javier F. Sarria received the M.Sc. degree from thePolytechnic University of Madrid, Madrid, Spain,in 2007.

He is currently with the Department of Auto-matic Control, Instituto de Automatica Industrial(IAI-CSIC), Madrid. He is specialized in themechanical design and control of legged robots. Hehas been working in the ROBOCLIMBER projectand in several other European-Commission-fundedprojects.

Hector Montes received the Ph.D. degree from theComplutense University of Madrid, Madrid, Spain,in 2005.

He is currently with the Department of AutomaticControl, Instituto de Automatica Industrial(IAI-CSIC), Madrid. He is specialized in electronics,signal processing, and control of legged robots. Hehas been working in the ROBOCLIMBER projectand in several other European-Commission-fundedprojects like Rower 2 robots for shipbuilding. Hehas special interest in force control and in biped

locomotion.

Manuel A. Armada received the Ph.D. degreein physics from the University of Valladolid,Valladolid, Spain, in 1979.

He is currently with the Department of Auto-matic Control, Instituto de Automatica Industrial(IAI-CSIC), Madrid. Since 1976, he has been in-volved in research activities related to control theory(singular perturbations and aggregation, bilinear sys-tems, adaptive and nonlinear control, multivariablesystems in the frequency domain, and digital control)and robotics (teleoperation, climbing, and walking

robots). He has been working in more than 50 RTD projects (includinginternational projects like EUREKA, ESPRIT, BRITE/EURAM, GROWTH,and others abroad the EU, particularly with Latin America (CYTED) andRussia). He owns several patents and has published over 150 papers (includingcontributions to several books, monographs, journals, international congresses,and workshops). He is currently the Vice Director of the Instituto de AutomaticaIndustrial (IAI-CSIC), a Member of the Russian Academy of Natural Sciences,and a Doctor Honoris Causa by the State Technical University (MADI),Moscow, Russia. His main research direction is concentrated in robot designand control, with especial emphasis in fields like force control and on walkingand climbing machines.

Dr. Armada has been presented with the IMEKO TC17 Award and twice withthe CSIC Silver Award.

Page 10: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1

High-Resolution Indirect Feet–Ground InteractionMeasurement for Hydraulic-Legged Robots

Samir Nabulsi, Javier F. Sarria, Hector Montes, and Manuel A. Armada

Abstract—Feet–ground interactions influence the legged robot’sstability. In this paper, a high-resolution indirect force measure-ment for hydraulic-legged robots is presented. The use of pres-sure transducers placed at one or both chambers of the robot’sdouble-effect hydraulic actuators is investigated, and conclusionsare drawn regarding their capability for indirectly measuringthe contact forces between the feet and the ground. Because ofthe nonlinear dynamic properties of hydraulic cylinders, frictionmodeling is essential to determine at all times the true forces ofeach foot against the soil. The test case is called ROBOCLIMBER,which is a bulky quadruped climbing and walking machine ableto carry heavy-duty drilling equipment for landslide consolidationand monitoring works. Sensor calibration and signal filteringrequirements are also taken into consideration. To end, the overallproposed approach to measure feet–ground interactions is experi-mentally evaluated.

Index Terms—Feet–ground interactions, friction modeling,hydraulic actuators, pressure sensors, quadruped robot, signalfiltering.

NOMENCLATURE

Notation for hydraulics

xp Differential cylinder piston position.φpiston Differential cylinder piston diameter.AA Differential cylinder chamber A area, piston

side.φrod Differential cylinder piston rod diameter.AB Differential cylinder chamber B area, rod side.Ap Piston area (used sometimes instead of AA).VA,B Differential cylinder chamber volumes.α = AB/AA Dimensionless factor relating both chambers.F Force.pA,B Differential cylinder pressure (chamber A, B).k Pressure sensor conversion factor.

Notation for the Kalman-based filter (KBF) equations

xk Updated process state vector estimate.Pk Error covariance matrix.

Manuscript received January 11, 2008; revised July 17, 2008. This workwas supported in part by Comunidad de Madrid under Grant RoboCity2030S-0505/DPI/0176. The ROBOCLIMBER project was funded by the EuropeanCommission under Contract G1ST-CT-2002-50160. The Associate Editor co-ordinating the review process for this paper was Dr. Jesús Ureña.

The authors are with the Department of Automatic Control, Instituto deAutomatica Industrial (IAI-CSIC), 28500 Madrid, Spain (e-mail: [email protected]; [email protected]; [email protected]; [email protected]).

Color versions of one or more of the figures in this paper are available onlineat http://ieeexplore.ieee.org.

Digital Object Identifier 10.1109/TIM.2009.2017650

Kk Kalman gain (blending factor).H Matrix giving the ideal (noiseless) connection between

the measurement and the state vector.Qk Covariance matrix.Rk Variance matrix.ek Prior covariance error.uk Vector assumed to be a white sequence with known

covariance structure.Φ State transition matrix.

I. INTRODUCTION

R ESEARCH on walking and climbing robots has receivedgreat attention during the last decade [1]–[4], and a broad

spectrum of applications have been reported in the literature,which range from shipbuilding [5], [6] and construction indus-try [7] to many others [8], [9]. Moreover, future applications ofservice robots entail in a relevant manner the development ofclimbing and walking machines [10], [11]. In particular, climb-ing robots could provide construction industries with usefultools to decrease human exposition to harmful working con-ditions and to increase productivity [12]. Rocky slope consoli-dation to avoid landslides is required before undertaking otherinfrastructure works (e.g., road, rail, and buildings). However,the current practice for slope consolidation involves dangerouslabor-intensive operations based on deep drilling using heavy-duty machinery to get holes at geologically selected locations inthe slope. Such holes (up to 20 m in depth) are filled in with con-crete, which reinforces the slope and, therefore, consolidates itand avoids landslides. Steel networks are then put in place tofinish the work [12]. ROBOCLIMBER (Fig. 1) is a quadrupedwalking and climbing robot whose development was fundedby the European Commission under a Cooperative ResearchProgram with the objective to develop a teleoperated servicerobotic system that could safely perform slope monitoring andconsolidation tasks [13], [14].

The robot is based on a mechanical structure [15] that issupported by four legs, where each leg provides three degrees offreedom in a cylindrical kinematic configuration (Fig. 2). Eachof the legs is able to support a total load of more than 15 000 N,and they are all able to carry the drilling unit and other auxiliaryequipment onboard, which lead to an overall weight of 4 tons.ROBOCLIMBER (a good report was released by DiscoveryChannel [16]) can work by walking and even climbing unevenmountain slopes with inclination ranging from 30◦ to almost90◦, and in this case, it is being held from the top of the moun-tain by two steel ropes, each of which is anchored to a certain

0018-9456/$26.00 © 2009 IEEE

Page 11: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

2 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 1. ROBOCLIMBER field tests (Alps, North Italy). Robot climbing isbeing performed with the help of cable traction devices.

Fig. 2. ROBOCLIMBER basic configuration: body platform and four legs.

distance from the other. The robot is equipped in its front sidewith two hydraulically operated traction devices that are usedfor grasping and pulling each steel rope, which leaves one endof the steel cable free (Fig. 1). The robot’s body displacementand the traction device pulling force must simultaneously becontrolled for proper climbing [17]. To develop a compact andreliable control system that is capable of running a large robotwith high reasonable safety, a suitable solution was to usedouble-effect (differential) hydraulically powered cylinders inall robot joints as actuators, which are controlled by means ofproportional valves. The hydraulic power unit (16 kW), drillingequipment, cable-pulling units, and control system are carriedon the robot (Fig. 1), and the robot is supervised from a remotelocation with no need of operators onboard [18].

II. INTEREST OF FEET–GROUND

INTERACTION MEASUREMENT

Legged robot displacement is obtained through the alterna-tion of the legs’ movements according to explicitly definedsequences [19]–[21]. Such gaits have implicit foot lift and downactions that result in alternating foot–ground contacts. The firstrequirement for a proper legged robot performance is stability.

Walking or climbing over flat surfaces could be achieved byusing appropriated gaits, but even in this ideal case, and mostlydue to robot mechanical imperfections, the robot’s movementsresult (generally after a short number of cycles) in loosing therobot’s attitude and instability [19].

To solve this problem, legged robots are equipped with somekind of on–off contact sensors at their feet, and using thissimple information, it is possible for the robot to walk and climbover uneven surfaces by stopping the leg when the foot contactsground or leaving it to go further the theoretical trajectory setpoint until contact is detected. However, this solution is notperfect, and there are many practical situations [e.g., due to achange in the working conditions (load and posture)] where thisapproach is not enough. A significant case is when perforationrods are being drilled into the mountain slope. Their weightaccounts to one-third of the robot weight, so this very muchaffects the payload distribution. Moreover, reaction forces inthe orthogonal direction to the slope are expected to change ina difficult-to-predict manner during drilling (involving hitting)and all through removing the drilling rods from the rocky slope.This will result in uncontrolled feet–ground contact loosing,which translates into undesirable robot vibrations. Moreover,the uneven surface requires using the third joints (vertical) ofthe legs to adjust and control the drilling unit orientation tobe as close as possible to 90◦ against the slope. Moreover,a robot of ROBOCLIMBER proportions could be useful formany other applications (apart from drilling), for example, inthe exploration or transport of equipment through hazardousareas. This yields to changing the total mass of the robot andto changes in their center of gravity, which lead to gait stabilityproblems. Therefore, it is required to propose other methods toovercome the problem.

One possible solution is to consider feet–ground contactforce measurement, where we feedback this measurement in-formation into the robot control system [20] to implementcontrol strategies to solve the aforementioned problems. Forexample, one of the most important applications could becontrolling the overall force distribution, which will allowcontrolling the momentum about the robot axis; this being veryimportant both for walking on uneven terrain and particularlyfor climbing on rough slopes [19]–[21]. Therefore, the firstmatter is to use vertical joints with force-sensing capability.Furthermore, because of the wide range of possible workingsituations for ROBOCLIMBER [21], force measurement in theother two joints has also been under consideration with the goalof controlling the overall force distribution and allowing theimplementation of force control algorithms for controlling therobot–environment interaction [22], [23].

III. INDIRECT FEET–GROUND INTERACTION

MEASUREMENT USING PRESSURE SENSORS

The ROBOCLIMBER control system employs position feed-back that is provided by 12 high-resolution encoders to measureprismatic joint excursions (joints 2 and 3 of each leg: 0.1-mmresolution) and rotation angle (joint 1 of each leg: 10 000 countsper revolution) to control with high accuracy the robot move-ments using 12 digital PID controllers tuned (independently)

Page 12: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 3

Fig. 3. ROBOCLIMBER’s vertical link of one leg made of steel subassem-blies with hydraulic cylinder inside.

for each joint [18]. The output of the position PID controllers(a pulse width modulation (PWM) signal) is converted to ananalog signal and fed to another set of 12 power servoamplifiersthat process these signals through another PID compensator thatprovides PWM signals to control the proportional valves (aninternal current feedback loop is used to smooth the intensity tothe solenoids). Proportional valves provide controlled oil flowinto the differential hydraulic cylinders (oil ports A and B),which results in piston positioning. Fig. 3 shows a diagram ofthe ROBOCLIMBER’s vertical link of one leg, which is madeof steel subassemblies with the hydraulic cylinder inside. Itconsists of two frames that slide against the other. The pistonrod has attached at its free end one foot that contacts the ground.

As previously explained, we are first interested in the mea-surement forces along the robot z-axis. One possible solutionhas stemmed after analyzing the force analysis acting on theleg foot (Fig. 3) [22], [23]. It can be inferred from this analysisthat the extension of the prismatic joint is made by the hy-draulic pressure inside the cylinder’s chamber, and therefore,this hydraulic pressure is the pressure that supports the weightof the robot. Therefore, a method to obtain information aboutcontact forces is to use pressure sensors placed at one orboth ends of the chambers (oil ports A and B, Fig. 3) of thedifferential cylinders and to obtain an indirect estimation of thecontact forces. The transducers usually employed to convertthe hydraulic pressure into electrical signals are the so-calledpressure transducers. The main advantage of these kinds oftransducers is that they are low cost, easy to install, reliable, andprovide good precision, but, of course, the different propertiesof the overall hydraulic system behavior should be taken into

TABLE IROBOCLIMBER TECHNICAL DATA

account [24]–[29]. Table I shows some technical data of theROBOCLIMBER. The next sections discuss the use of sensorsin one or two of the oil ports.

A. Force Measurement Using Pressure Information FromOne Chamber

For our application, hydraulic GEMS 2200 pressure sensorswith an operating pressure range between 0 and 100 bar,providing a signal from 0 to 5 V, and with 0.25% precisionand thermal error of 1.25% (full scale) were selected. The firstapproximation consisted of the measurement of the force FA

supported by the upper chamber of the hydraulic cylinder foreach leg (Fig. 3) using only one transducer at oil port A andmeasuring the force according to

FpA = pA · AA (1)

where AA is the piston area (Table I), and pA is the pressuremeasured with the sensor just placed at oil port A. With the se-lected sensor, it is then possible to have a theoretical sensitivityof 96 N.

The pressure sensor output signal is processed by a modularinstrumentation amplifier that combines high accuracy, lownoise, high-precision gain, high linearity, and temperature com-pensation. Because the leg manufacturing process is not ideal,a tuning process has to be done on the amplifiers for all legs toperceive with high-resolution interaction forces independent ofmechanical differences. The purpose of the tuning process is tofind the relationship between the output signal of the amplifier(Vout) and the pressure (p), which aims to adjust dc bias,amplifier gain, and bandwidth. The tuning method consistedof using one leg at a time, which leaves the others raised (noground contact). Then, the subject leg is vertically moved withthe foot contacting a calibrated reference load cell (maximumpayload of 30 000 N, 10-N precision, and 1.7 N of standarddeviation), and using (1), the force measurements provided bythe load cell are converted to pressure. This tuning has theadvantage (and the goal) of compensating, in some way, theinherent inaccuracies of using pressure measurement in onlyone chamber to simplify the sensor setup (and to decrease cost).The values of each of the devices were gathered in real time.Given the pressure equation [where k is the pressure conversionfactor (20 × 105 N/(m2 × V)], we have

p = k(aVout + b). (2)

Page 13: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

4 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 4. Chamber A pressure sensor tuning.

TABLE IICALIBRATION VALUES FOR THE PRESSURE EQUATION

A linear regression was done with the Matlab Curve FittingTool using the data obtained during the tuning process. Theresult is graphically shown in Fig. 4, and the a and b parametersfor each leg are listed in Table II.

To evaluate and eventually better understand the possiblelimitations of using only one pressure sensor, several exper-iments were conducted. The robot was equipped with foursensors at oil port A of the vertical joints. The first experimentconsisted of raising the robot on four legs under velocity controland in several steps from its rest position (robot body framecontacting ground, feet up), to several new positions, stoppingsome time at each one, and proceeding to the next. The resultsare shown in Fig. 5.

The first thing to notice is that the control system perfectlykeeps each vertical joint position, but there is a clear force decaythat is motivated by a pressure decay inside chamber A, andas a consequence, the apparent weight of the overall machineis decreasing very slowly with time in a significant amountand converging slowly to a stationary value that matches theactual machine weight. While this could be useful in otherapplications, however, for our control purposes of fast detectionand proper control of contact forces, it cannot be accepted.

The main reason for this situation resides in the nature ofthe hydraulic circuit and its components. Capacitive effects andnonlinearities [26], [27] are the most likely reasons for thatsituation.

The next experiment consisted of an evaluation of the dy-namic behavior of the proposed measurement system. The sim-plest possible test was to measure the given force while movinga vertical joint according to a sinusoidal wave function (for thespeed) (Fig. 6) with no additional payload, i.e., the foot is notcontacting ground, and so force is employed to overcome the in-

ternal sliding leg frame weight of the leg and friction. In all theexperiments shown in this paper, the oil temperature was low.

As a result of the experiment, it is possible to notice thatthe behavior is as expected, which means that the joint’s forcecalculated using (1) is actuating according to the accelerationof the movement. However, as can be noticed in Fig. 6, forcemeasurement attains peak values of about 2100 N, whereas intheory, if the joint is actuating without any external payload,then the joint should not be measuring any additional load apartfrom their internal frame (which accounts for 900 N). One ofthe main reasons of having about 2100-N force measurementwithout additional payload could be friction, but it is mostlikely also because measurement at only oil port A is notenough for our application (it is of course very valid for manyother practical cases [26], [27]), and we foresee the need totake into account what happens inside chamber B. Addition-ally, other phenomena due to pressure distribution across thehydraulic circuit could be taken into account. To overcomethose inconvenient situations, which are noticeable from theobtained results, the use of differential pressure measurementis proposed in the next section. In addition, friction modelingwill be accomplished in the subsequent section.

B. Force Measurement Using Pressure Information FromTwo Chambers

One way to minimize the effects of pressure variations insidethe hydraulic circuit is to measure the differential pressurebetween both chambers [26], [27]. The method consists ofmeasuring the pressure acting on the piston by adding a secondsensor at actuator input B to measure the differential pressurethat exists between chambers A and B, and, as consequence, tomeasure the static force that the rod is exerting in the verticaldirection (Fz) by using the following equation:

Fz = Fp(pA, pB) = FpA − FpB = (pA − αpB)Ap. (3)

Ap is the area of the piston, and α is the differential factorbetween both chambers [27] (please refer to Table I for actualparameter values). The sensor at oil port B is connected tothe port through a rigid pipe at about 0.7 m from the port.Connections from both sensors to the hydraulic power unit areby means of a combination of flexible hoses and rigid pipes.The length of such a hydraulic circuit is several meters.

To notice the effect in force measurement using the pressuredifference from both sides of the piston, the cylinder wassubject to a sinusoidal reference input in speed. In this case,the effects introduced by acceleration are liberalized, but thisdoes not happen with friction effects, as can be noticed in therecorded graphic (Fig. 7). This experiment was realized in thesame conditions like the previous experiment, and it is possibleto notice that both leg speed and force at chamber A are thesame (Fig. 6). In addition, it is interesting to point out that theresulting force values are actually more clearly connected withthe inner load in movement. The negative sign for resultantforces in Fig. 7 needs to be interpreted just as a conventionto indicate the direction of movement (force projection againstrobot reference frame).

Page 14: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 5

Fig. 5. Force measurement at vertical joints using only one pressure sensor at each oil port A of the robot actuators (horizontal axis means time in seconds).

Fig. 6. Force measurement using sensor at chamber A of a vertical joint.

Fig. 7. Differential force measured using pressure sensors at both oil ports ofthe hydraulic cylinder.

As a conclusion, the force Fp computed using the pressuredifference signal is well suited to measure the “true” contactforce and should be preferred to the use of only one transducerat chamber A or B. The use of two transducers also hasadditional advantages.

1) Temperature effects are minimized when friction mea-surements are used. Temperature variations dramaticallychange the oil viscosity, but differential measurementminimizes that effect.

2) Low-velocity measurements are now more reliable andaccurate (under 5 mm/s), whereas with only one chambermeasurement, speed measurement is always problematic.This is very important, for example, when implementingforce control strategies.

3) In addition, as a third advantage, this approach doesnot require perfect parameterization of friction, whichsimplifies the computation.

IV. FRICTION MODELING

As it is well known, one of the main nonlinearities of thecylinder model is nonlinear friction [27]–[29]. To understandthe influence of friction in the overall response of the cylinders,a standard method to counteract the influence of friction againstthe measurement of the differential pressure on the hydraulicfluid is to measure the force actuating in the joint without theinfluence of any external load during the displacement with acertain velocity xp according to the Stribeck model [26]–[28]

Ff (xp) = Fv(xp) + Fc(xp) + Fs(xp)

= σxp + sign(xp)[Fc0 + Fs0 exp

(−|xp|

cs

)]. (4)

In (3), the friction force is made up of three different partswith the following meaning:

Fv viscous friction;σ parameter for viscous friction;Fc Coulomb friction;

Page 15: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

6 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 8. Results of friction modeling experiments for vertical links.

Fc0 parameter for the Coulomb friction;Fs static friction;Fs0 parameter for the static friction;cs parameter for the static friction, known as the Stribeck

velocity.To take into account the differential cylinder asymmetry, it is

convenient to use a modification of (4) as follows:

Ff (xp)

=

⎧⎨⎩

σ+xp + sign(xp)[F+

c0 + F+s0 exp

(−|xp|

c+s

)]∀xp ≥ 0

σ−xp + sign(xp)[F−

c0 + F−s0 exp

(−|xp|

c−s

)]∀xp < 0.

(5)

It is possible to experimentally identify friction parametersby finding the relationship between the velocity of the jointand the measured force. Usually, this identification must bedone without any additional payload and in horizontal position(without the influence of gravity), and in this case, it is possibleto easily find the parameters associated with friction [27]. How-ever, in our case, the friction modeling process has been doneby leaving the vertical joint in its regular position without beinguninstalled from the robot structure, where it is possible tomodel the effects of the mechanical structure of the joints, likethe weight of the inner joint bodies, the structural mechanicalfriction of the prismatic joint, and the gravity effects. Aiming tothat purpose, for the model identification of one of the verticaljoints, the cylinder has been actuated in different positive andnegative velocities, without touching the ground with the foot,while the forces were measured.

Fig. 8 shows the results of the experimental modeling of theactuator friction, and it is possible to notice that for each ofthe velocities in which the force (differential pressure) has beenmeasured, the force is not around a certain point but among awide set of measurements. This is because the friction forcenot only changes according to the velocity but according to theextension of the hydraulic cylinder (it depends on its position;this theoretical assumption [27], [28] is well corroborated hereby experimentation), where there is a difference among thefluids in each chamber at each instant.

TABLE IIISTRIBECK FRICTION PARAMETERS FOR PRISMATIC VERTICAL JOINT

Table III shows the obtained Stribeck parameters for thisexperiment. These parameters were found out by an approxima-tion process (parameter tuning was done using simple identifi-cation algorithm [27], [28]), which defined the Stribeck-basedbehavior of the friction for a certain vertical prismatic joint.

The resulting function is like a typical Stribeck model, butwith a few differences. The most important difference is thatthe slope of the friction according to the viscous behavior ineach sign of the velocity is different from each other. This isbecause of the vertical position of the prismatic joint, where itis necessary to support its own inner weight while it is moving.In conclusion, it has been shown that a good modeling of fric-tion has been accomplished through extensive experimentation.This work has been done for all robot joints.

In addition to the effects described before, there are dif-ferent phenomena (e.g., fluid compression, stick-slip effect,etc.), other than the implicit signal noise, that influence thehydraulic system dynamics. Using the experimental setup withROBOCLIMBER, some of these effects have been studied(Fig. 9). Although they do not necessarily have to be takeninto account for a hypothetical force control system, they areof interest to better understand the actuator behavior.

V. SIGNAL FILTERING

For reactive control purposes, it is needed to handle signalsthat could provide accurate and reliable force measurementwith high resolution. This obviously implies signal filtering.Being the previous sections devoted to understand and to modelthe hydraulics, and to investigate the best way to obtain precisemeasurements of feet–ground interactions, some considerationson filtering for this application are herein presented. After hav-ing good experimental information about the involved signalsin our problem, some first- and second-order digital filtershave been tested; even different types of Kalman filters havebeen tested too. However, after preliminary trials, it has beendecided to use a modified KBF [30], [31] to improve the qualityof the force measurements based on the hydraulic pressure.This modified KBF (Fig. 10) is a digital recursive solution forreal-time applications [31]. The process [Fig. 10, (1)] startsby giving a prior estimation of the process state vector xk−1,the error covariance Pk−1, and the maximum threshold emaxdetermined for our system. It is assumed that at this point, it is intime tk, and that this prior estimate is based on our knowledgeof the process before tk.

The next problem is to find the particular blending factor Kk

[Fig. 10, (2)] that yields an update estimate that is optimal insome sense. This estimation can be controlled by the varianceR, which in our case can be assumed constant and was experi-mentally obtained.

Page 16: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 7

Fig. 9. Example of force signal obtained using differential pressure mea-surements and identification of fluid compression and stick-slip phenomena(horizontal axis means time in seconds, vertical scale means force in newtons).

Fig. 10. Modified KBF loop.

With the assumption of a prior estimate xk−1, it is necessaryto use the actual measurement zk to improve the prior estimatexk−1 (4). However, the different types of effects actuating in thehydraulic circuit can degenerate this estimation because mostof these effects cause high pecks in zk. Therefore, to improvethe measurement by taking into account the external effects,additional control estimation has been added to improve the

robustness of the filter where xk would not be updated if thecovariance error ek overpasses emax [Fig. 10, (3)], where

ek = zk − xk−1. (6)

The next step is to evaluate the error covariance vector Pk

associated with the updated estimate [Fig. 10, (5)]. Finally, theprocess must update the future state vector xk+1 and covariancevector Pk+1 [Fig. 10, (6)], which is evaluated with a constantcovariance matrix Qk (which, in this case, is also assumedconstant and experimentally determined).

The significant effectiveness of the filter can be changed bymodifying the R and Qk values. If R is increased, then themeasurements prior to tk will have more influence over xk, andif Qk increases, then the influence of the actual measurementwill increase too. For the experimental results presented inthe next section, R and Qk values were determined throughmany trial-and-error testing. This was enough for our presentpurposes.

VI. EXPERIMENTAL RESULTS

This section is devoted to a final experimental verificationof the proposed methodology. To do that, the experiment willconsist of trying to obtain a signal that only represents theactual force acting on the system (one actuator), which filtersout undesirable dynamic effects. Moreover, it will be shown thatan additional KBF provides definitive results.

A. Friction Modeling

It is possible to measure the force acting on the cylinderwithout the dynamic effects by only measuring the externalpayload using the following equation, where nonlinear frictionis introduced [27], [28]:

F ext(pA,pB, xp) = F p(pA,pB) − F f . (7)

To verify the result of using the Stribeck-model-based func-tion, the same example of the sinusoidal movement of the joint(please refer to Fig. 7) has been used, subtracting from thedifferential force signal the friction-based Stribeck model.

As it is possible to notice from the force behavior (seeFig. 11), the results form the external forces measured fromthe differential forces, and the friction parameterization of thevertical joint are very acceptable, where the forces of the jointare around zero when there is no external payload acting.

However, there are still some high and low peaks. Thesepeaks are the result of the behavior of the hydraulic systemwhen the cylinder is actuating at low velocities, where it is verydifficult to model the system [26].

B. Signal Filtering

As explained before, a suitable way to take advantage ofthe KBF to filter complex signals is to add a threshold inthe covariance error ek. The problem is that in the hydraulicsystem, there are many external effects that are exhibited in thepressure, and in consequence, in force evaluation. Most of theseeffects are shown in the form of high peaks.

Page 17: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

8 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT

Fig. 11. Illustration of the use of friction modeling.

Fig. 12. Illustration of filtering approaches applied to force measurements.

TABLE IVPARAMETERS FOR THE FILTERING PROCESS

As an example, Fig. 12 presents a graphic that shows thedifference between a filtered signal with a discrete KBF andthe signal filtered with the proposed modified KBF and itsRk parameters Qk, and the maximum threshold in the secondcase emax (Table IV). As it is possible to notice, with themodified KBF, the filtered signal follows the same tendency ofthe original signal, but avoiding the dynamic effects of the lowvelocities in the hydraulic actuator.

VII. CONCLUSION

Force measurement is a very important issue in the devel-opment process of a semiautonomous walking robot for the im-provement of its robustness. ROBOCLIMBER is a heavyweight

quadruped robot designed for performing complex operationsover natural terrain, where it is necessary to use robust andreliable sensor systems.

Instead of creating or installing any external force sensor,a proper solution is to use the hydraulic system properties tocompute the force generated by the joints of the system. Thisforce is evaluated by measuring the pressure in the hydraulicflow of the joints’ oil ports of actuators. The hydraulic pressuretransducers are well known in the market, relatively cheap, andeasy to adapt in the hydraulic circuit.

However, the problem is that when the pressure in the hy-draulic system is measured, not only the dynamic effects of thehydraulic components affect the system, but also any unknownbehavior of the complete system is intrinsically incorporatedand so measured in the pressure signal.

That is why it is so important to understand the hydraulicsystem behavior and the most important effects that can origi-nate alterations in the system. In this paper, some of the mostimportant effects associated with the practical use of hydraulicactuators have been studied, which are mostly concentratedin the vertical links of the ROBOCLIMBER whose free endsare the feet that interact with the ground. It has been shownhow proper friction modeling is required, because it greatlyinfluences the system response. The method used to model thefriction in the vertical joint is also applicable to the other jointsof the system, although that has been omitted here for brevity.Another important issue was to investigate the use of one or twopressure sensors. For accurate and dynamically representativeforce measurements, it can be concluded that the use of twosensors is the only choice for our application.

To improve the precision and reliability of the signals pro-vided by the friction model, and after many digital filter analy-sis, for this application, the use of the modified KBF has beenproposed.

With those results, it can also be concluded that, forhydraulic-legged robots, the indirect force computed with theproposed methodology presents significant advantages in termsof accuracy, reliability, simplicity, and low cost when comparedwith previous approaches of direct force measurement usingload cells [21], [22].

ACKNOWLEDGMENT

The authors would like to thank Dr. R. Caballero fromPanama Technical University for his kind help regardingKalman filtering. This paper is an extended version of [24]presented at the IEEE International Workshop on IntelligentSignal Processing (WISP) 2007.

REFERENCES

[1] P. González de Santos, M. Armada, A. Martin, and W. de Peuter, “Asurvey of locomotion concepts for planetary exploration rovers,” inProc. 3rd ESA Workshop Adv. Space Technol. Robot Appl., Noordwjck,The Netherlands, 1994.

[2] M. Armada and P. González de Santos, “Climbing, walking and inter-vention robots,” Ind. Robot—An International Journal, vol. 24, no. 2,pp. 158–163, 1997.

Page 18: IEEE TRANSACTIONS ON INSTRUMENTATION AND …digital.csic.es/bitstream/10261/17731/3/Nabulsi_High... · 2016. 3. 10. · IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 1 High-Resolution

NABULSI et al.: INDIRECT FEET–GROUND INTERACTION MEASUREMENT FOR HYDRAULIC-LEGGED ROBOTS 9

[3] M. Armada, “Climbing and walking: From research to applications,”in Proc. 3rd Int. Conf. Climbing Walking Robots, Madrid, Spain, 2000,pp. 39–48.

[4] G. S. Virk, G. Muscato, A. Semerano, M. Armada, and H. A. Warren,“The CLAWAR project on mobile robotics,” Ind. Robot—An Interna-tional Journal, vol. 31, no. 2, pp. 130–138, 2004.

[5] P. González de Santos, M. Armada, and M. A. Jiménez, “Ship buildingwith ROWER,” IEEE Robot. Autom. Mag., vol. 7, no. 4, pp. 35–43,Dec. 2000.

[6] J. C. Grieco, M. Prieto, M. Armada, and P. González de Santos, “Asix-legged climbing robot for high payloads,” in Proc. IEEE Int. Conf.Control Appl., Trieste, Italy, 1998, pp. 446–450.

[7] M. Armada and P. González de Santos, “Perspectives of climbing andwalking robots for the construction industry,” in Proc. 4th Int. Conf.Climbing Walking Robots, Paris, France, 2001, pp. 929–936.

[8] M. Armada, P. González de Santos, M. A. Jiménez, and M. Prieto, “Ap-plication of CLAWAR machines,” Int. J. Robot. Res., vol. 22, no. 3/4,pp. 251–264, 2003.

[9] Balaguer, G. S. Virk, and M. Armada, “Robot applications againstgravity,” IEEE Robot. Autom. Mag., vol. 13, no. 1, pp. 5–6, Mar. 2006.

[10] M. Armada, “Robotics: Now and beyond,” Ind. Robot—An InternationalJournal, vol. 32, no. 2, p. 97, Apr. 2005.

[11] E. Garcia, M. A. Jiménez, P. González de Santos, and M. Armada, “Theevolution of robotics research,” IEEE Robot. Autom. Mag., vol. 14, no. 1,pp. 90–103, Mar. 2007.

[12] M. Armada and R. M. Molfino, “Improving working conditions andsafety for landslide consolidation and monitoring,” in Workshop RoleCLAWAR Educ., Training, Working Conditions Safety, Madrid, Spain,2002.

[13] P. Anthoine, M. Armada, S. Carosio, P. Comacchio, F. Cepolina,P. González, T. Klopf, F. Martin, R. C. Michelini, R. M. Molfino,S. Nabulsi, R. P. Razzoli, E. Rizzi, L. Steinicke, R. Zannini, andM. Zoppi, “ROBOCLIMBER,” in 1st Int. Workshop ASER, Bardolino,Italy, Mar. 13–15, 2003.

[14] P. Anthoine, M. Armada, S. Carosio, P. Comacchio, F. Cepolina,P. González, T. Klopf, F. Martin, R. C. Michelini, R. M. Molfino,S. Nabulsi, R. P. Razzoli, E. Rizzi, L. Steinicke, R. Zannini, andM. Zoppi, “ROBOCLIMBER: A four-legged climbing robot for rockyslope consolidation and monitoring,” in 10th ISORA, Seville, Spain, 2004.

[15] R. Molfino, M. Armada, F. Cepolina, and M. Zoppi, “ROBOCLIMBERthe 3 ton spider,” Ind. Robot—An International Journal, vol. 32, no. 2,pp. 163–170, 2005.

[16] Roboclimber Project. [Online]. Available: http://www.iai.csic.es/dca/dac_Robots.html

[17] S. Nabulsi and M. Armada, “Climbing strategies for remotemaneuverability of ROBOCLIMBER,” in 35th ISR, Paris, France,2004.

[18] S. Nabulsi, M. Armada, and P. González de Santos, “Control architecturefor a four-legged hydraulically actuated robot,” in Proc. ISMCR, Madrid,Spain, 2003, pp. 291–295.

[19] P. González de Santos and M. A. Jiménez, “Generation of discontinuousgaits for quadruped walking vehicles,” J. Robot. Syst., vol. 12, no. 9,pp. 599–611, 1995.

[20] S. Hirose and Y. Kuneida, “Generalized standard foot trajectory for aquadruped walking vehicle,” Int. J. Robot. Res., vol. 10, no. 1, pp. 3–12,Feb. 1991.

[21] M. Prieto, M. Armada, and S. Ros, “Continuous climbing control for thelegged robot REST-2,” in 3rd Int. Conf. CLAWAR, Madrid, Spain, 2000,pp. 491–498.

[22] H. Montes, S. Nabulsi, and M. Armada, “Design and implementationof force sensor for roboclimber,” in Proc. Int. Conf. CLAWAR, Madrid,Spain, 2004, pp. 219–228.

[23] H. Montes, S. Nabulsi, and M. Armada, “Reliable, built-in, high-accuracyforce sensing strategies in walking robots,” Int. J. Robot. Res., vol. 25,no. 9, pp. 931–950, Sep. 2006.

[24] S. Nabulsi, J. F. Sarria, and M. Armada, “Indirect force measurementfor hydraulic walking robot,” in Proc. IEEE Int. Symp. WISP, Alcala deHenares, Spain, 2007, pp. 753–757.

[25] H. E. Merrit, Hydraulic Control Systems. New York: Wiley, 1967.[26] T. J. Viersma, Analysis, Synthesis and Design of Hydraulic Servosystems

and Pipelines. Amsterdam, The Netherlands: Elsevier, 1980.[27] M. Jelali and A. Kroll, Hydraulic Servo-Systems: Modelling, Identifica-

tion and Control. Berlin, Germany: Springer-Verlag, 2003.[28] B. Armstrong-Helouvry, P. Dupont, and C. Canudas de Wit, “A survey

of models, analysis tools and compensation methods for the control ofmachines with friction,” Automatica, vol. 30, no. 7, pp. 1083–1138,Jul. 1994.

[29] J. Polzer and D. Nissing, “Mechatronic design using flatness based controlto compensate for a lack of sensors,” in Proc. Mechatronics, Darmstadt,Germany, 2000.

[30] R. Brown and P. Hwang, Introduction to Random Signals and AppliedKalman Filtering. New York: Wiley, 1985.

[31] G. Welck and G. Bishop, “An introduction to the Kalman filter,” Univ.North Carolina, Chapel Hill, NC, TR 95-041, Jul. 24, 2006.

Samir Nabulsi received the M.Sc. degree from thePolytechnic University of Madrid, Madrid, Spain, in2007 and the Ph.D. degree from the ComplutenseUniversity of Madrid, Madrid, in 2008.

He is currently with the Department of Auto-matic Control, Instituto de Automatica Industrial(IAI-CSIC), Madrid. He is specialized in the me-chanical design and control of legged robots. Hehas been working in the ROBOCLIMBER projectand in several other European-Commission-fundedprojects.

Javier F. Sarria received the M.Sc. degree from thePolytechnic University of Madrid, Madrid, Spain,in 2007.

He is currently with the Department of Auto-matic Control, Instituto de Automatica Industrial(IAI-CSIC), Madrid. He is specialized in themechanical design and control of legged robots. Hehas been working in the ROBOCLIMBER projectand in several other European-Commission-fundedprojects.

Hector Montes received the Ph.D. degree from theComplutense University of Madrid, Madrid, Spain,in 2005.

He is currently with the Department of AutomaticControl, Instituto de Automatica Industrial(IAI-CSIC), Madrid. He is specialized in electronics,signal processing, and control of legged robots. Hehas been working in the ROBOCLIMBER projectand in several other European-Commission-fundedprojects like Rower 2 robots for shipbuilding. Hehas special interest in force control and in biped

locomotion.

Manuel A. Armada received the Ph.D. degreein physics from the University of Valladolid,Valladolid, Spain, in 1979.

He is currently with the Department of Auto-matic Control, Instituto de Automatica Industrial(IAI-CSIC), Madrid. Since 1976, he has been in-volved in research activities related to control theory(singular perturbations and aggregation, bilinear sys-tems, adaptive and nonlinear control, multivariablesystems in the frequency domain, and digital control)and robotics (teleoperation, climbing, and walking

robots). He has been working in more than 50 RTD projects (includinginternational projects like EUREKA, ESPRIT, BRITE/EURAM, GROWTH,and others abroad the EU, particularly with Latin America (CYTED) andRussia). He owns several patents and has published over 150 papers (includingcontributions to several books, monographs, journals, international congresses,and workshops). He is currently the Vice Director of the Instituto de AutomaticaIndustrial (IAI-CSIC), a Member of the Russian Academy of Natural Sciences,and a Doctor Honoris Causa by the State Technical University (MADI),Moscow, Russia. His main research direction is concentrated in robot designand control, with especial emphasis in fields like force control and on walkingand climbing machines.

Dr. Armada has been presented with the IMEKO TC17 Award and twice withthe CSIC Silver Award.