# A Barycenter Control Method for the Bioinspired Forest Chassis Robot on Slope

Authors: Tingting Sui; Jinhao Liu; Jianli Wang; Jianting Zhang
Journal: Journal of Robotics
 (2021)

---

## Abstract

To improve the stability of forestry chassis on the slope, a chassis-installed barycenter adjustable mechanism (BAM) is designed, and the control method of the counterweight is proposed to make the chassis barycenter move suitably to achieve the design purpose. The kinematic analysis of BAM is carried out, and the relationship between the translation, rotation, and vertical displacement of counterweight and the chassis barycenter is calculated. Furthermore, the variation curves obtained in Matlab show the barycenter can translate 100 mm, rotate from 0 to 360 degrees, and lower about 180 mm in the vertical direction. Adams is adopted to complete the kinematics simulation of the chassis, indicating that the control method can effectively adjust the barycenter position. Finally, experiments are carried out under slope conditions to analyze chassis stability by testing plantar pressure. The results show that forest chassis using the barycenter control method helps keep stable on the slope of 15 degrees, much better than standard normal chassis.


---

## Body

## 1. Introduction

The site conditions of forestry production are characterized by rugged terrain and slope conditions in China. Stable movement of equipment chassis is an essential guarantee for the regular operation of forestry machinery. However, research on unique vehicle chassis in forestry terrain is relatively weak compared with that at home. Due to the significant terrain differences, the forest vehicle chassis developed by other countries has insufficient adaptability in China’s forests [1, 2]. Therefore, it is imperative to develop unique vehicle chassis with better operation stability for sloping forest land [3].Traditional wheeled chassis have severe mobility restrictions on rough terrain [4]. The articulated mining vehicle researched by Zhou et al. can keep the front and rear tracks in good contact with the ground to ensure that it is suitable for complex terrain [5]. The six-wheel swing arm forestry chassis proposed by Sun Zhibo can improve the chassis stability by changing its posture and ensure that it still has the good adaptive ability on rough terrain [6]. Gao et al. designed the obstacle crossing chassis (V2-HVPC) with balanced rocker arm suspension. The chassis adjusted the wheel base according to the road conditions to improve the terrain trafficability. Also, the chassis’ driving stability on uneven road surfaces was studied and verified [7, 8].Compared with wheeled or tracked chassis, quadruped chassis has outstanding advantages in terrain adaptability and environmental protection. At the same time, it is difficult for quadruped chassis to keep stable walking on the slope. The main problem is the barycenter is high, so that the chassis is easy to overturn. Because of quadruped chassis stability on the slope, many methods are proposed to calculate the stability, including the stability margin (SM), the zero moment point (ZMP) theory, and Kalakrishnan’s walking gait of the quadruped chassis by planning the ZMP trajectory [9–12]. The position and height of barycenter are important factors affecting the chassis stability, so it is an excellent idea to consider how to use centroid adjustment to improve the operation stability of quadruped chassis under slope conditions. In essence, suitable structure design is the basis of motion stability for chassis.It is a standard method to add a barycenter adjustment mechanism to assist the control of the whole machine’s barycenter, such as the counterweight used in the construction site and the inertial flywheel to adjust the attitude of the satellite. In addition, the bionic engineering method is widely adopted to develop the barycenter adjustment mechanism by inspiration from nature. As far as quadrupeds are concerned, all kinds of quadrupeds can adjust the barycenter, not only by the forward and backward movement of limbs and trunk but also by other structures and organs. When the cheetah runs, its tail helps to maintain stability. Obviously, in the process of sharp turning, the cheetah will quickly swing its tail to the other side to prevent instability. The Cheetah with mounted 2-DOF tail developed by MIT is used to study the tail and body interaction. The research results show that tail swing can reduce the motion system's lateral disturbance [13]. Like cheetahs, when a cat falls or jumps from a height, it can also adjust its body posture by swinging its tail quickly to ensure its balance [14]. In all kinds of accidental falls, lizards can adjust their tails to make their bodies nearly level to ensure that they can land on the ground with their feet. A UC Berkeley research team proposed a car with a tail by studying the effect of lizards' and dinosaurs' tails on adjusting body balance. Comparative experiments show that the car with a tail has better spatial stability [15–17]. According to the kangaroo's physiological structure, movement characteristics, and the tail’s role in the movement, the researchers proposed a bionic jumping robot model with a tail. The analysis results show that the tail can adjust the jumping posture and degree and reduce the touchdown force. The research of Bionic Kangaroo has proved that the tail can significantly change the robot’s attitude in the air [18]. There are many other studies on improving system stability by using adjustment mechanisms [19, 20]. Goats can adjust the barycenter position using the head, neck, and other physiological structures. The goats live in the rugged mountain environment, and the rock antelope is a modern relative of a goat. However, the study found that the goat’s muscle is more developed than that of the rock antelope, especially the shoulder and neck. Also, the short and robust limbs and prominent shoulder muscles are the goat’s apparent characteristics [21]. Compared with other climbing animals, such as bighorn sheep, the goat has a lower barycenter [22]. Anatomically, a goat’s chest height is much lower than that of bighorn sheep, and the hoof area of a goat is more prominent [23]. Combined with many factors, including a large proportion of forelimbs, slightly lower forebody, long neck, and developed shoulder muscle tissue, it is helpful for goats to climb or pass through complex terrain. Ryan T analyzed the climbing mechanism of goats. In the stage of forelimb pedaling and extension, the trunk barycenter should be as close to the ground as possible.During the pull-up phase, the trunk barycenter experienced vertical and horizontal movements of about 23 cm and 15 cm, respectively. When the hind limbs are pushed off the ground, the vertical distance of the trunk barycenter's vertical distance relative to the hind hooves is about 48 cm, and the horizontal distance is about 38 cm [24]. The research shows that goats can keep their body stable by adjusting the barycenter all the time when passing through complex terrain. Zhang Fu et al. analyzed the movement characteristics of goats on the slope. The results show that the walking gait can be optimized by adjusting the barycenter position. In addition, the influence of goat head control on the machine operation is studied, and the control strategy to improve the balance performance is obtained [25, 26].Inspired by the barycenter adjustment of goats passing complex terrain, this paper proposes a bionic chassis installed barycenter adjustable mechanism (BAM) based on the auxiliary effect of goat head and neck on barycenter adjustment. Based on the stability margin, a new method to adjust the chassis barycenter is proposed, realized by changing the BAM’s parameters. The advantage of this method is that the control is simple. Two aspects of barycenter adjustment can be realized together: on the one hand, the chassis barycenter can be adjusted to make the projection point fall inside the support polygon on the ground to improve the stability margin; on the other hand, it can lower the centroid height to prevent the chassis from rolling over. The correctness and effectiveness of the proposed method are verified by simulation. Based on the model drawings and simulation results, the prototype is manufactured and experiments are conducted. The results prove the validity of the structure and method.


## 2. Materials and Methods

### 2.1. Structure Design

The stability of mechanical operation is poor on slope terrain. The barycenter of the chassis directly affects its stability. Based on this, the design requirement that the chassis system has better stability on the slope is put forward. The forestry chassis with BAM is mainly composed of legs, frame, and drive system, as shown in Figure1.Figure 1
Sketch of forestry chassis with BAM.The barycenter’s projection on a slope does not coincide with that on flat ground when the chassis is stationary. If the chassis starts to move, the barycenter shifts that are prone to overturn. The BAM needs to help keep the chassis barycenter within the stability margin by adjusting the counterweight position to avoid the chassis rolling over. Based on this, a new 3-DOF barycenter balance mechanism that can realize the translation (R), rotation (θa), and vertical (σ) motion of the counterweight is proposed, as shown in Figure 2. The counterweight is driven by motors to change the chassis barycenter position as needed by adjusting R, θa, and σ.Figure 2
Model of barycenter balance structure.
(a)(b)


### 2.2. Motion Analysis of the Barycenter Adjustable Mechanism

To analyze the barycenter position of BAM, its coordinate system should be established first. It is noted that BAM is considered a symmetrical structure. The influence of motor is ignored due to its small mass. Based on motion features, parts are classified into three groups: connecting rods, connecting plate, and slide rail; counterweight; and motor 3. Therefore,G of BAM’s coordinate system is defined with its origin at the geometric center of the connecting plate. The simplified model and coordinate system are shown in Figure 1, and parameters are presented in Table 1.Table 1
Parameter of the barycenter balance mechanism.
StructureParaUnitTotal mass of BAMMGkgMass of 8 linksMakgMass of connecting plateMbkgMass of counterweightMckgRotate angle of motor 1θa(°)Angle between link and levelσ(°)Mass of frameM0kgLength of linkLGmmHeight of counterweighthmmRange of counterweightRmmDistance between plate and framehGmmHeight of frameHmmAccording to the working principle of BAM, the distance between the connecting plate and the chassis frame can be obtained:(1)hG=2LG×sinσ+d2+d1.Let the barycentric coordinate of BAM isGBxB,yB,zB, and that of Ma is Gaxa,ya,za, Mb is Gbxb,yb,zb, and Mc is Gcxc,yc,zc. The barycentric coordinate of each group is obtained based on Figure 1:(2)xa,ya,za=0,0,−H2+d1+d22+LG⋅sinσ,xb,yb,zb=0,0,−H2+d1+d2+2⋅LG⋅sinσ+d3,xc,yc,zc=R⋅cosθa,R⋅sinθa,−H2+d1+d2+2⋅LG⋅sinσ+d3+h2,G0=x,y,z=∑i=acMiGi∑i=acMi,∑i=acMi=MG=Ma+Mb+Mc,(3)x=xc⋅R⋅cosθaMG,y=yc⋅R⋅sinθaMG,z=−za⋅H2+d1+d22+LG⋅sinσ−zb⋅H2+d1+d2+2⋅LG⋅sinσ+d3.The forest chassis structure is relatively regular, so the corresponding center of gravity can be calculated. To reduce the variables in the theoretical calculation, it is reasonably simplified into two parts, frame and legs. In addition, assuming that all chassis are of the same homogeneous material, each part’s geometric center is its barycenter. The weight of the legs is ignored since it is relatively small compared with the whole chassis. Thus, the barycenter is determined by the frame and barycenter balanced structure, and the barycenter of the frame coincides with its geometric center.Let the barycentric coordinate of the forestry chassis isGx,y,z, which can be obtained based on formula (3):(4)x=M0⋅x0+MG⋅xGM,y=M0⋅y0+MG⋅yGM,z=M0⋅z0+MG⋅zGM,where M=M0+MG.Based on the above mathematical analysis and the motion parameters in Table2, the barycenter varying law of BAM and the chassis with different parameter values are analyzed. On the basis of structure, the rotation range of BAM is 0 to 360 degrees. To avoid repetition, the chassis frame is divided into four parts, and the quarter section is selected as the analysis area, as shown in Figure 2(b). 1, 2, 3, and 4 represent four support points of chassis, 1, 2, and 3 are in the supporting phase and 4 is in the swing phase. Namely, the motion range of counterweight is 0 to 90 degrees.Table 2
Parameter value of balance mechanism.
ParametersR (mm)θa (°)σ (°)10–12000200–900300–900–9040–12000–9050–1200–9006000–9070–1200–900–9080, 60, 12000


### 2.3. Control Method of Chassis Barycenter

Compared with the flat terrain, it is more difficult for the chassis to walk on the slope condition. The reason is that the projection of barycenter on the support surface is not on the same horizontal plane as the support points of each leg, and the horizontal projection area of the support triangle becomes smaller so that the stability margin (Sm) becomes lower. Sm should be greater than 0, and it is better to reach the maximum Smmax. More significant Sm conduces to improve the chassis stability. Based on this, a method is proposed to increase Sm.The initial state of forestry chassis on a slope is shown as Figure3, and the frame is parallel to the inclined plane. It is assumed that the barycenter coincides with the origin of the frame coordinate system. As the chassis moves in a static gait, each leg is raised alternately. The barycenter’s projection on the slope surface will change continuously along with the support triangles formed by the other three supporting legs. Projection of barycenter falls in the back of projection area. What's worse, projection of barycenter will fall outside the support polygon with large inclination. Thus, the barycenter’s projection is close to the limit position, which makes the chassis stability extremely poor, or during the gait transformation, especially when the hind leg is in the swing phase, projection of barycenter falls outside the polygon, causing the chassis to tip over. Therefore, it is a great idea to adjust the barycenter to ensure that projection of barycenter is always in the support triangle and increase the stability margin as much as possible.Figure 3
Projection of barycenter and barycenter adjustment.The intersection point of two diagonal lines is taken as the origin to define the barycenter projection's stable area. As long as the barycenter’s projection falls at the inner of the supporting triangle, the chassis gets the maximum stability margin. Thus, the chassis barycenter translatesRmax and rotates θa. Namely, the horizontal forward displacement of chassis barycenter is R0.Let the translation of counterweight isR, and rotation is θa and vertical drop hz, correctly, parameters of BAM can ensure the chassis barycenter’s projection falls close to the triangle inner, improving the stability margin. As shown in Figure 3, M is the intersection of diagonal lines of chassis support points. K1 is the distance between M and the projection of the chassis barycenter. K2 is the displacement that the chassis barycenter moves forward with the adjustment of BAM. Based on the stability margin, the stability condition of chassis motion is as in formula (5):(5)K1<K2.The above conditions can ensure thatSm is more significant than zero, but it may be inadequate. To increase Sm, the stability condition of chassis motion can be further determined as(6)K1<K2≤K1+R0.Figure3 shows the chassis barycenter before and after BAM adjustment. OB is the initial position of the chassis barycenter, and OB′ is the position after adjustment.The position coordinates ofOB, x0,z0 in the reference coordinate system OF is as in(7)x0=lx,z0=lz.In the initial state, the vertical distance from the chassis barycenter to the inclined plane can be calculated according to the kinematics, as shown in(8)lz=L1⋅sinθ1+L2⋅sinθ1+θ2+L3.After moving forward, position coordinates ofOB′, x′,z′ in the reference coordinate system OF is as in(9)x′=lx+hx=lx+R⋅cosθa,z′=lz−hz.Thus,K1 and K2 can be calculated as follows:(10)K1=L1⋅sinθ1+L2⋅sinθ1+θ2+L3⋅sinθ,K2=hx2+hz2⋅cosarccosOBB′¯2+OBF′¯2−OBF¯22⋅OBB′¯⋅OBF′¯−θ−arctanlz−hzlz+hx.By substituting the above results in formula (6), we can get the following relation:(11)L1⋅sinθ1+L2⋅sinθ1+θ2+L3⋅sinθ<hx2+hz2⋅cosarccosOBB′¯2+OBF′¯2−OBF¯22⋅OBB′¯⋅OBF′¯−θ−arctanlz−hzlz+hx≤L1⋅sinθ1+L2⋅sinθ1+θ2+L3⋅sinθ+W2+L26.


### 2.4. Gait and Trajectory Planning

The forest chassis needs to complete the under forest operation in a narrow space on slope terrain. The chassis requires to keep stable operation, and it is not necessary for the chassis to move at medium-high speed due to the forest environment.The route of chassis motion is idealized as a straight line here. Based on the fact that the barycenter is as close as possible to the inner of the supporting triangle, the barycenter adjustment is added to the chassis’ steady static gait to improve the stability margin. We take the six-leg stepping sequences of leg 2 swinging first as an example. The number and amount of barycenter adjustment are analyzed to reduce the impact of barycenter adjustment on the motion system's stability. Moreover, the distance of barycenter adjustment in a cycle is allocated to each phase to achieve a slight distance adjustment in a single movement. The shaking caused by inertial force due to the large movement of barycenter and the risk of robot overturning can be reduced. The time required for each execution phase is fully used to make the barycenter moving trajectory smooth and the motion more efficient. Therefore, the leg swing sequence is selected as 2-1-4-3 for semi-intermittent continuous gait planning. The gait sequence is shown in Figure4 in which the solid line part represents the support phase. The sketch of gait and barycenter adjustment is shown in Figure 5.Figure 4
Semi-intermittent continuous gait sequence.Figure 5
Sketch of barycenter adjustment.Based on the compound cycloid, a modified trajectory suitable for forest chassis is planned here. As shown in Figure6, the chassis' front leg trajectory is planned in the shoulder joint coordinate system. The compound cycloid is adopted to plan the swing phase trajectory PFF′⌢, and the linear equation is used for support phase trajectory PFF′¯.Figure 6
Trajectory planning of front leg.Tis when four legs complete a movement, and t is the time variable in one cycle (0≤t≤T). According to the chassis gait, Tsw (swing phase) =T/4, Tst (support phase) =3/4T. In one-fourth cycle (0≤t≤Tsw), the foot swings from PF to PF′ along the moving direction. The trajectory cannot have sudden change of velocity and acceleration in the conversion process of support phase and swing phase to keep stable movement. Thus, the limit conditions are as in(12)xsw20=−S2,xsw2T4=0,xsw21=S2,x˙sw20=0,x˙sw2T4=0,x˙sw21=0,x¨sw20=0,x¨sw2T4=0,x¨sw21=0.In motion direction, the foot trajectory of swing phase adopts the cycloid equation as shown in equations (13) and (14) that are obtained after integration, and equation (15) is obtained after integrating twice:(13)x¨sw2t=A1sin4πt0≤t≤Tsw,(14)x˙sw2t=−A14πcos4πt+C10≤t≤Tsw,(15)xsw2t=−A14π2sin4πt+C1t+C20≤t≤T4.A1, C1, and C2 are obtained by substituting the limiting conditions into the formula, and then the formula of foot trajectory along motion direction in the x-axis is obtained as in(16)xsw2t=−Snπsinnπt+St−S2=St−1nπsinnπt−S20≤t≤Tsw.To determine the suitable value ofn, curves of xsw2t with n=2, 4, 6, 8 are plotted in Matlab; Figure 7 shows that the trajectory is smoothest as n=2.Figure 7
xsw2t varies with n.For the y-axis, the leg motion in the swing phase can be divided into two processes, and the foot lifts from zero position and reach the highest point whent=Tsw/2, then lowers to ground. At t=Tsw/2, the foot position is determined as ysw2Tsw/2=−H0+H. Also, the transition of the foot end from the swing phase to the supporting phase needs to satisfy the continuity and acceleration of the equation, and the restriction condition is as in(17)ysw20=−H0,ysw2Tsw2=−H0,ysw21=−H0,y˙sw20=0,y˙sw2Tsw2=0,y˙sw21=0,y¨sw20=0,y¨sw2Tsw2=0,y¨sw21=0.According to the motion order, the leg lifting trajectory from zero position to the highest point is first planned, and equation (18) is selected as the acceleration equation. The parameters are obtained through the integral formula, and the foot lifting trajectory is as in(18)y¨sw2t=A2sinnπt0≤t≤Tsw2,(19)ysw2t=2Ht−1nπsinnπt−H00≤t≤Tsw2.The trajectories of foot falling and lifting are symmetrical in they-direction. The foot falling trajectory is obtained as in(20)ysw2t=2H1−t+1nπsinnπt−H0Tsw2≤t≤Tsw.The curve ofyswft shows that when n=4, the curve is most stable. Therefore, the foot trajectory equation of the foreleg in the swing phase is as in(21)xsw2t=St−12πsin2πt−S20≤t≤Tsw,ysw2t=2Ht−14πsin4πt−H00≤t≤Tsw2,2H1−t+14πsin4πt−H0Tsw2≤t≤Tsw.In the supporting phase, the foot does not move on the ground, while the body moves forward relative to the ground, so the foot slides fromPF’ to PF, resulting in a straight line. Based on the gait, the constraints are as follows:(22)xst21=S2,xst2T=−S2.The foot has no displacement in the y-axis, soyst2 = H0 is a fixed value. The trajectory equation along the forward direction of the x-axis is a linear function, as shown in(23)xst2t=Sa0t+a11≤t≤T.The formula of trajectory in the supporting phase is obtained through the restriction condition (24):(24)xst2t=S−13t+56,yst2T=−H0,1≤t≤T.Take the following parameters as examples:T=4s, step length S=200 mm, lifting height H= 60 mm, and the distance between shoulder joint to foot H=360 mm. In the shoulder coordinate system, the compound cycloid trajectory of the foot is shown in Figure 8.Figure 8
Foot trajectory of one front leg.Figure9 shows the displacement, velocity, and acceleration curves along the x-axis. Figure 10 shows the displacement, velocity, and acceleration curves along the y-axis. The results show that in the swing phase to support phase and swing phase to support phase, the foot can avoid dragging on the ground, and at the moment of transition, the speed and acceleration change smoothly without the mutation.Figure 9
Foot displacement, velocity, and acceleration curves inx-direction.Figure 10
Foot displacement, velocity, and acceleration curves in they-direction.


## 2.1. Structure Design

The stability of mechanical operation is poor on slope terrain. The barycenter of the chassis directly affects its stability. Based on this, the design requirement that the chassis system has better stability on the slope is put forward. The forestry chassis with BAM is mainly composed of legs, frame, and drive system, as shown in Figure1.Figure 1
Sketch of forestry chassis with BAM.The barycenter’s projection on a slope does not coincide with that on flat ground when the chassis is stationary. If the chassis starts to move, the barycenter shifts that are prone to overturn. The BAM needs to help keep the chassis barycenter within the stability margin by adjusting the counterweight position to avoid the chassis rolling over. Based on this, a new 3-DOF barycenter balance mechanism that can realize the translation (R), rotation (θa), and vertical (σ) motion of the counterweight is proposed, as shown in Figure 2. The counterweight is driven by motors to change the chassis barycenter position as needed by adjusting R, θa, and σ.Figure 2
Model of barycenter balance structure.
(a)(b)


## 2.2. Motion Analysis of the Barycenter Adjustable Mechanism

To analyze the barycenter position of BAM, its coordinate system should be established first. It is noted that BAM is considered a symmetrical structure. The influence of motor is ignored due to its small mass. Based on motion features, parts are classified into three groups: connecting rods, connecting plate, and slide rail; counterweight; and motor 3. Therefore,G of BAM’s coordinate system is defined with its origin at the geometric center of the connecting plate. The simplified model and coordinate system are shown in Figure 1, and parameters are presented in Table 1.Table 1
Parameter of the barycenter balance mechanism.
StructureParaUnitTotal mass of BAMMGkgMass of 8 linksMakgMass of connecting plateMbkgMass of counterweightMckgRotate angle of motor 1θa(°)Angle between link and levelσ(°)Mass of frameM0kgLength of linkLGmmHeight of counterweighthmmRange of counterweightRmmDistance between plate and framehGmmHeight of frameHmmAccording to the working principle of BAM, the distance between the connecting plate and the chassis frame can be obtained:(1)hG=2LG×sinσ+d2+d1.Let the barycentric coordinate of BAM isGBxB,yB,zB, and that of Ma is Gaxa,ya,za, Mb is Gbxb,yb,zb, and Mc is Gcxc,yc,zc. The barycentric coordinate of each group is obtained based on Figure 1:(2)xa,ya,za=0,0,−H2+d1+d22+LG⋅sinσ,xb,yb,zb=0,0,−H2+d1+d2+2⋅LG⋅sinσ+d3,xc,yc,zc=R⋅cosθa,R⋅sinθa,−H2+d1+d2+2⋅LG⋅sinσ+d3+h2,G0=x,y,z=∑i=acMiGi∑i=acMi,∑i=acMi=MG=Ma+Mb+Mc,(3)x=xc⋅R⋅cosθaMG,y=yc⋅R⋅sinθaMG,z=−za⋅H2+d1+d22+LG⋅sinσ−zb⋅H2+d1+d2+2⋅LG⋅sinσ+d3.The forest chassis structure is relatively regular, so the corresponding center of gravity can be calculated. To reduce the variables in the theoretical calculation, it is reasonably simplified into two parts, frame and legs. In addition, assuming that all chassis are of the same homogeneous material, each part’s geometric center is its barycenter. The weight of the legs is ignored since it is relatively small compared with the whole chassis. Thus, the barycenter is determined by the frame and barycenter balanced structure, and the barycenter of the frame coincides with its geometric center.Let the barycentric coordinate of the forestry chassis isGx,y,z, which can be obtained based on formula (3):(4)x=M0⋅x0+MG⋅xGM,y=M0⋅y0+MG⋅yGM,z=M0⋅z0+MG⋅zGM,where M=M0+MG.Based on the above mathematical analysis and the motion parameters in Table2, the barycenter varying law of BAM and the chassis with different parameter values are analyzed. On the basis of structure, the rotation range of BAM is 0 to 360 degrees. To avoid repetition, the chassis frame is divided into four parts, and the quarter section is selected as the analysis area, as shown in Figure 2(b). 1, 2, 3, and 4 represent four support points of chassis, 1, 2, and 3 are in the supporting phase and 4 is in the swing phase. Namely, the motion range of counterweight is 0 to 90 degrees.Table 2
Parameter value of balance mechanism.
ParametersR (mm)θa (°)σ (°)10–12000200–900300–900–9040–12000–9050–1200–9006000–9070–1200–900–9080, 60, 12000


## 2.3. Control Method of Chassis Barycenter

Compared with the flat terrain, it is more difficult for the chassis to walk on the slope condition. The reason is that the projection of barycenter on the support surface is not on the same horizontal plane as the support points of each leg, and the horizontal projection area of the support triangle becomes smaller so that the stability margin (Sm) becomes lower. Sm should be greater than 0, and it is better to reach the maximum Smmax. More significant Sm conduces to improve the chassis stability. Based on this, a method is proposed to increase Sm.The initial state of forestry chassis on a slope is shown as Figure3, and the frame is parallel to the inclined plane. It is assumed that the barycenter coincides with the origin of the frame coordinate system. As the chassis moves in a static gait, each leg is raised alternately. The barycenter’s projection on the slope surface will change continuously along with the support triangles formed by the other three supporting legs. Projection of barycenter falls in the back of projection area. What's worse, projection of barycenter will fall outside the support polygon with large inclination. Thus, the barycenter’s projection is close to the limit position, which makes the chassis stability extremely poor, or during the gait transformation, especially when the hind leg is in the swing phase, projection of barycenter falls outside the polygon, causing the chassis to tip over. Therefore, it is a great idea to adjust the barycenter to ensure that projection of barycenter is always in the support triangle and increase the stability margin as much as possible.Figure 3
Projection of barycenter and barycenter adjustment.The intersection point of two diagonal lines is taken as the origin to define the barycenter projection's stable area. As long as the barycenter’s projection falls at the inner of the supporting triangle, the chassis gets the maximum stability margin. Thus, the chassis barycenter translatesRmax and rotates θa. Namely, the horizontal forward displacement of chassis barycenter is R0.Let the translation of counterweight isR, and rotation is θa and vertical drop hz, correctly, parameters of BAM can ensure the chassis barycenter’s projection falls close to the triangle inner, improving the stability margin. As shown in Figure 3, M is the intersection of diagonal lines of chassis support points. K1 is the distance between M and the projection of the chassis barycenter. K2 is the displacement that the chassis barycenter moves forward with the adjustment of BAM. Based on the stability margin, the stability condition of chassis motion is as in formula (5):(5)K1<K2.The above conditions can ensure thatSm is more significant than zero, but it may be inadequate. To increase Sm, the stability condition of chassis motion can be further determined as(6)K1<K2≤K1+R0.Figure3 shows the chassis barycenter before and after BAM adjustment. OB is the initial position of the chassis barycenter, and OB′ is the position after adjustment.The position coordinates ofOB, x0,z0 in the reference coordinate system OF is as in(7)x0=lx,z0=lz.In the initial state, the vertical distance from the chassis barycenter to the inclined plane can be calculated according to the kinematics, as shown in(8)lz=L1⋅sinθ1+L2⋅sinθ1+θ2+L3.After moving forward, position coordinates ofOB′, x′,z′ in the reference coordinate system OF is as in(9)x′=lx+hx=lx+R⋅cosθa,z′=lz−hz.Thus,K1 and K2 can be calculated as follows:(10)K1=L1⋅sinθ1+L2⋅sinθ1+θ2+L3⋅sinθ,K2=hx2+hz2⋅cosarccosOBB′¯2+OBF′¯2−OBF¯22⋅OBB′¯⋅OBF′¯−θ−arctanlz−hzlz+hx.By substituting the above results in formula (6), we can get the following relation:(11)L1⋅sinθ1+L2⋅sinθ1+θ2+L3⋅sinθ<hx2+hz2⋅cosarccosOBB′¯2+OBF′¯2−OBF¯22⋅OBB′¯⋅OBF′¯−θ−arctanlz−hzlz+hx≤L1⋅sinθ1+L2⋅sinθ1+θ2+L3⋅sinθ+W2+L26.


## 2.4. Gait and Trajectory Planning

The forest chassis needs to complete the under forest operation in a narrow space on slope terrain. The chassis requires to keep stable operation, and it is not necessary for the chassis to move at medium-high speed due to the forest environment.The route of chassis motion is idealized as a straight line here. Based on the fact that the barycenter is as close as possible to the inner of the supporting triangle, the barycenter adjustment is added to the chassis’ steady static gait to improve the stability margin. We take the six-leg stepping sequences of leg 2 swinging first as an example. The number and amount of barycenter adjustment are analyzed to reduce the impact of barycenter adjustment on the motion system's stability. Moreover, the distance of barycenter adjustment in a cycle is allocated to each phase to achieve a slight distance adjustment in a single movement. The shaking caused by inertial force due to the large movement of barycenter and the risk of robot overturning can be reduced. The time required for each execution phase is fully used to make the barycenter moving trajectory smooth and the motion more efficient. Therefore, the leg swing sequence is selected as 2-1-4-3 for semi-intermittent continuous gait planning. The gait sequence is shown in Figure4 in which the solid line part represents the support phase. The sketch of gait and barycenter adjustment is shown in Figure 5.Figure 4
Semi-intermittent continuous gait sequence.Figure 5
Sketch of barycenter adjustment.Based on the compound cycloid, a modified trajectory suitable for forest chassis is planned here. As shown in Figure6, the chassis' front leg trajectory is planned in the shoulder joint coordinate system. The compound cycloid is adopted to plan the swing phase trajectory PFF′⌢, and the linear equation is used for support phase trajectory PFF′¯.Figure 6
Trajectory planning of front leg.Tis when four legs complete a movement, and t is the time variable in one cycle (0≤t≤T). According to the chassis gait, Tsw (swing phase) =T/4, Tst (support phase) =3/4T. In one-fourth cycle (0≤t≤Tsw), the foot swings from PF to PF′ along the moving direction. The trajectory cannot have sudden change of velocity and acceleration in the conversion process of support phase and swing phase to keep stable movement. Thus, the limit conditions are as in(12)xsw20=−S2,xsw2T4=0,xsw21=S2,x˙sw20=0,x˙sw2T4=0,x˙sw21=0,x¨sw20=0,x¨sw2T4=0,x¨sw21=0.In motion direction, the foot trajectory of swing phase adopts the cycloid equation as shown in equations (13) and (14) that are obtained after integration, and equation (15) is obtained after integrating twice:(13)x¨sw2t=A1sin4πt0≤t≤Tsw,(14)x˙sw2t=−A14πcos4πt+C10≤t≤Tsw,(15)xsw2t=−A14π2sin4πt+C1t+C20≤t≤T4.A1, C1, and C2 are obtained by substituting the limiting conditions into the formula, and then the formula of foot trajectory along motion direction in the x-axis is obtained as in(16)xsw2t=−Snπsinnπt+St−S2=St−1nπsinnπt−S20≤t≤Tsw.To determine the suitable value ofn, curves of xsw2t with n=2, 4, 6, 8 are plotted in Matlab; Figure 7 shows that the trajectory is smoothest as n=2.Figure 7
xsw2t varies with n.For the y-axis, the leg motion in the swing phase can be divided into two processes, and the foot lifts from zero position and reach the highest point whent=Tsw/2, then lowers to ground. At t=Tsw/2, the foot position is determined as ysw2Tsw/2=−H0+H. Also, the transition of the foot end from the swing phase to the supporting phase needs to satisfy the continuity and acceleration of the equation, and the restriction condition is as in(17)ysw20=−H0,ysw2Tsw2=−H0,ysw21=−H0,y˙sw20=0,y˙sw2Tsw2=0,y˙sw21=0,y¨sw20=0,y¨sw2Tsw2=0,y¨sw21=0.According to the motion order, the leg lifting trajectory from zero position to the highest point is first planned, and equation (18) is selected as the acceleration equation. The parameters are obtained through the integral formula, and the foot lifting trajectory is as in(18)y¨sw2t=A2sinnπt0≤t≤Tsw2,(19)ysw2t=2Ht−1nπsinnπt−H00≤t≤Tsw2.The trajectories of foot falling and lifting are symmetrical in they-direction. The foot falling trajectory is obtained as in(20)ysw2t=2H1−t+1nπsinnπt−H0Tsw2≤t≤Tsw.The curve ofyswft shows that when n=4, the curve is most stable. Therefore, the foot trajectory equation of the foreleg in the swing phase is as in(21)xsw2t=St−12πsin2πt−S20≤t≤Tsw,ysw2t=2Ht−14πsin4πt−H00≤t≤Tsw2,2H1−t+14πsin4πt−H0Tsw2≤t≤Tsw.In the supporting phase, the foot does not move on the ground, while the body moves forward relative to the ground, so the foot slides fromPF’ to PF, resulting in a straight line. Based on the gait, the constraints are as follows:(22)xst21=S2,xst2T=−S2.The foot has no displacement in the y-axis, soyst2 = H0 is a fixed value. The trajectory equation along the forward direction of the x-axis is a linear function, as shown in(23)xst2t=Sa0t+a11≤t≤T.The formula of trajectory in the supporting phase is obtained through the restriction condition (24):(24)xst2t=S−13t+56,yst2T=−H0,1≤t≤T.Take the following parameters as examples:T=4s, step length S=200 mm, lifting height H= 60 mm, and the distance between shoulder joint to foot H=360 mm. In the shoulder coordinate system, the compound cycloid trajectory of the foot is shown in Figure 8.Figure 8
Foot trajectory of one front leg.Figure9 shows the displacement, velocity, and acceleration curves along the x-axis. Figure 10 shows the displacement, velocity, and acceleration curves along the y-axis. The results show that in the swing phase to support phase and swing phase to support phase, the foot can avoid dragging on the ground, and at the moment of transition, the speed and acceleration change smoothly without the mutation.Figure 9
Foot displacement, velocity, and acceleration curves inx-direction.Figure 10
Foot displacement, velocity, and acceleration curves in they-direction.


## 3. Results

### 3.1. Barycenter Variation Curves

Representative barycenter variation curves according to parameters are shown in Figure11. The results show that when the counterweight shifts 120 mm without rotation or falling, the barycenter deviates with the counterweight in the same direction (x) and the offset is 100 mm. The lateral (y) and vertical (z) do not change. However, if the counterweight does not shift, the rotation and vertical motion parameters rotate from 0° to 90°, and the barycenter of BAM gradually decreases along the z-direction, while no variation in the x- and y-direction. If the counterweight shifts and descends without rotation, the barycenter moves along the x-direction and lower. As the counterweight moves with three parameters concurrently, the barycenter is constantly lower while varying in the x- and y-direction. Finally, three groups of fixed translation values are taken; it can be seen that the longer the translation, the greater the barycenter offset. However, as the counterweight rotates, the barycenter offset in the x-direction gradually decreases to 0, while the offset in the y-direction gradually increases to the maximum.Figure 11
Barycenter varies with parameters. (a)R = 0–120, θa = 0°, σ = 0–90°; (b) R = 0–120, θa = 0–90°, σ = 0°; (c) R = 0–120, θa = 0–90°, σ = 0–90°; and (d) R = 0, 60, 120, θa = 0–90°, σ = 0–90°.
(a)(b)(c)(d)Figure11(d) clearly shows that the variation of barycenter in the x- and y-direction intersects when the counterweight is closest to the inner of the supporting triangle. At the same time, if the vertical displacement of the counterweight is the largest, namely, the three parameters are R = 120 mm, θa = 45°, σ = 90°, the barycenter of BAM reaches the maximum adjustment, bringing the same effect on chassis barycenter, to improve the chassis stability.


### 3.2. Simulation

According to the above results, it is evident that BAM can adjust the chassis barycenter, but its motion characteristics during one adjustment cycle are still unclear. Therefore, in this section, Adams software is adopted to simulate the motion under the static gait. The virtual prototype built and assembled in Solid Edge with the same physical parameters (Table3), and BAM is simplified for the convenience of simulation. Then, the x-t file is imported into Adams for simulation. The adjustment parameters of BAM are set as R = 100 mm, θa = 45 degrees, and σ = 50 degrees. The simulation process is shown in Figure 12.Table 3
Parameters of chassis prototype.
ParameterBodyLink 1Link 2Link 3BAMLength (mm)690 × 455 × 817616870Mass (Kg)70.70.60.24MaterialAluminum alloyFigure 12
Model of chassis with BAM used in the simulation.The simulation results of BAM adjustment and chassis climbing are shown in Figure13. Climbing is the whole process of the chassis moving from the flat to the slope. During the moving process, the barycenter of the chassis frame fluctuates in a small range and keeps stable, as shown in Figure 13(a).Figure 13
(a) Centroid curve of the chassis frame. (b) Centroid curve of counterweight.
(a)(b)Figure13(b) shows the result of one adjustment cycle of the BAM. The motion initialization includes three processes, and the counterweight rotates 45 degrees first, then it shifts, and finally it drops by about 150 mm. During the rotation, the counterweight stays in the center, without variation in three directions. With translational motion, the barycenter moves to the support triangle. Finally, the barycenter drops significantly with the links moving from horizontal to vertical. Then, BAM rotates 90 degrees with the chassis step, which shows that the barycenter curve of BAM varies regularly.As a result, it can be seen that the BAM can adjust the barycenter position by changing parameters, so that the stability margin can be improved, contributing to the stability of the chassis in slope conditions.


### 3.3. Experiment

The chassis platform is shown in Figure14(a), consisting of servo motors, linear actuators, and BAM, and the parameters are presented in Table 3. The hardware configuration of BAM mainly includes three motors drives, two sets of rails and sliders with a length of 240 mm, a screw, a precision bearing, and a counterweight. Three drives controlled through Arduino are used to drive motors separately. Figure 14(b) shows the control hardware configuration. Considering that the motor shaft will always bear load during movement, a precision bearing is used for connecting that can bear the load from the lower parts and avoid damage to the shaft. The precision linear rail and slide adopt a rolling friction model, which significantly reduces the friction coefficient, and it can bear the load of counterweight. Additionally, the counterweight-driven way is specifically designed that simplifies the structure by using the motor as a part of the counterweight. The counterweight is driven to raise or lower through a screw, convenient for accurate driving based on pitch and lead.Figure 14
(a) State of BAM before and after adjustment. (b) Control hardware configuration.Other experimental equipment is as follows: the Arduino, a laptop, 6 sets of pressure sensors (model: RFP803), and matching conversion module (model: RFP-ZHII) as shown in Figure15(a), and connecting lines. The output data of the conversion module are obtained as voltage. Figure 15(b) shows the duration curve of the high- and low-voltage output of the conversion module. The power supply voltage of the conversion module is 5 V. When no load is applied, the module outputs a high voltage. At this time, the measured voltage is 1024 mV. With the increase in load, the input voltage of the module decreases. The test data result is 280 mV, which is the maximum load.Figure 15
(a) Hardware for data reading. (b) Calibration of force and voltage.
(a)(b)Stability experiments are carried out on simplified slope conditions, which are manually made by hand, as shown in Figure16. Slope conditions of 0, 5, 10, 15, and 20 degrees are created, and the slope is adjusted after each experiment, avoiding the impact of the last test. Each test is done more than three times.Figure 16
Pressure test of (a) chassis and (b) chassis installedBAM.
(a)(b)Two sets of comparative tests are conducted according to the following procedures. Under slope working conditions, the chassis is easy to roll over when the rear leg is in swing phase. Due to the symmetrical chassis structure, the pressure value change is only tested when the left rear leg is raised and the other three legs are in the supporting phase. The first set of pressure values is measured with a standard chassis, as shown in Figure16(a). Pressure values of the three supporting legs are obtained under the above slope conditions to be a control group. For comparison, the other set of pressure values with FC and BAM is measured and recorded to be test group, and the three parameters are taken as R = 120 mm, θa = 45 degrees, and σ = 45 degrees.The results are shown in Table4, and the standard chassis can be stable on a slope of 5 degrees, while the chassis installed barycenter adjustable mechanism can be stable on the slope of 15 degrees.Table 4
Test conditions and values.
TestInclination(°)ChassisChassis installedBAMV2 (mV)V3 (mV)V2′ (mV)V3′ (mV)1044538143236925845365522331310——634325415——795309Note.V2, V2′ are the plantar pressures of leg 2, and V3, V3′ are the plantar pressures of leg 3.The stability of a standard chassis and forestry chassis with BAM is compared by analyzing two groups of plantar pressure data. It shows that the plantar pressure of standard chassis’ leg 2 on the slope of 5 degrees is about 10 N and that of leg 3 is about 70 N. The contrastive value is 39 N for leg 2 of the chassis with BAM and 77 N for leg 3 on the same slope.The plantar pressure of the chassis with BAM is more significant than that of the standard chassis. The self-weight of the BAM is one reason to slightly increase the plantar pressure. The key reason is that the counterweight adjustment makes the barycenter of the chassis move to the support triangle, increasing the pressure of foreleg 2 to improve the chassis stability. As the slope becomes steeper, the plantar force of leg 3 increases and that of leg 2 decreases. On the slope of 15 degrees, the pressure of foreleg 2 is about 14 N and that of leg 3 is about 83 N. The results reflect that BAM is conductive to the chassis stability under slope working conditions.


## 3.1. Barycenter Variation Curves

Representative barycenter variation curves according to parameters are shown in Figure11. The results show that when the counterweight shifts 120 mm without rotation or falling, the barycenter deviates with the counterweight in the same direction (x) and the offset is 100 mm. The lateral (y) and vertical (z) do not change. However, if the counterweight does not shift, the rotation and vertical motion parameters rotate from 0° to 90°, and the barycenter of BAM gradually decreases along the z-direction, while no variation in the x- and y-direction. If the counterweight shifts and descends without rotation, the barycenter moves along the x-direction and lower. As the counterweight moves with three parameters concurrently, the barycenter is constantly lower while varying in the x- and y-direction. Finally, three groups of fixed translation values are taken; it can be seen that the longer the translation, the greater the barycenter offset. However, as the counterweight rotates, the barycenter offset in the x-direction gradually decreases to 0, while the offset in the y-direction gradually increases to the maximum.Figure 11
Barycenter varies with parameters. (a)R = 0–120, θa = 0°, σ = 0–90°; (b) R = 0–120, θa = 0–90°, σ = 0°; (c) R = 0–120, θa = 0–90°, σ = 0–90°; and (d) R = 0, 60, 120, θa = 0–90°, σ = 0–90°.
(a)(b)(c)(d)Figure11(d) clearly shows that the variation of barycenter in the x- and y-direction intersects when the counterweight is closest to the inner of the supporting triangle. At the same time, if the vertical displacement of the counterweight is the largest, namely, the three parameters are R = 120 mm, θa = 45°, σ = 90°, the barycenter of BAM reaches the maximum adjustment, bringing the same effect on chassis barycenter, to improve the chassis stability.


## 3.2. Simulation

According to the above results, it is evident that BAM can adjust the chassis barycenter, but its motion characteristics during one adjustment cycle are still unclear. Therefore, in this section, Adams software is adopted to simulate the motion under the static gait. The virtual prototype built and assembled in Solid Edge with the same physical parameters (Table3), and BAM is simplified for the convenience of simulation. Then, the x-t file is imported into Adams for simulation. The adjustment parameters of BAM are set as R = 100 mm, θa = 45 degrees, and σ = 50 degrees. The simulation process is shown in Figure 12.Table 3
Parameters of chassis prototype.
ParameterBodyLink 1Link 2Link 3BAMLength (mm)690 × 455 × 817616870Mass (Kg)70.70.60.24MaterialAluminum alloyFigure 12
Model of chassis with BAM used in the simulation.The simulation results of BAM adjustment and chassis climbing are shown in Figure13. Climbing is the whole process of the chassis moving from the flat to the slope. During the moving process, the barycenter of the chassis frame fluctuates in a small range and keeps stable, as shown in Figure 13(a).Figure 13
(a) Centroid curve of the chassis frame. (b) Centroid curve of counterweight.
(a)(b)Figure13(b) shows the result of one adjustment cycle of the BAM. The motion initialization includes three processes, and the counterweight rotates 45 degrees first, then it shifts, and finally it drops by about 150 mm. During the rotation, the counterweight stays in the center, without variation in three directions. With translational motion, the barycenter moves to the support triangle. Finally, the barycenter drops significantly with the links moving from horizontal to vertical. Then, BAM rotates 90 degrees with the chassis step, which shows that the barycenter curve of BAM varies regularly.As a result, it can be seen that the BAM can adjust the barycenter position by changing parameters, so that the stability margin can be improved, contributing to the stability of the chassis in slope conditions.


## 3.3. Experiment

The chassis platform is shown in Figure14(a), consisting of servo motors, linear actuators, and BAM, and the parameters are presented in Table 3. The hardware configuration of BAM mainly includes three motors drives, two sets of rails and sliders with a length of 240 mm, a screw, a precision bearing, and a counterweight. Three drives controlled through Arduino are used to drive motors separately. Figure 14(b) shows the control hardware configuration. Considering that the motor shaft will always bear load during movement, a precision bearing is used for connecting that can bear the load from the lower parts and avoid damage to the shaft. The precision linear rail and slide adopt a rolling friction model, which significantly reduces the friction coefficient, and it can bear the load of counterweight. Additionally, the counterweight-driven way is specifically designed that simplifies the structure by using the motor as a part of the counterweight. The counterweight is driven to raise or lower through a screw, convenient for accurate driving based on pitch and lead.Figure 14
(a) State of BAM before and after adjustment. (b) Control hardware configuration.Other experimental equipment is as follows: the Arduino, a laptop, 6 sets of pressure sensors (model: RFP803), and matching conversion module (model: RFP-ZHII) as shown in Figure15(a), and connecting lines. The output data of the conversion module are obtained as voltage. Figure 15(b) shows the duration curve of the high- and low-voltage output of the conversion module. The power supply voltage of the conversion module is 5 V. When no load is applied, the module outputs a high voltage. At this time, the measured voltage is 1024 mV. With the increase in load, the input voltage of the module decreases. The test data result is 280 mV, which is the maximum load.Figure 15
(a) Hardware for data reading. (b) Calibration of force and voltage.
(a)(b)Stability experiments are carried out on simplified slope conditions, which are manually made by hand, as shown in Figure16. Slope conditions of 0, 5, 10, 15, and 20 degrees are created, and the slope is adjusted after each experiment, avoiding the impact of the last test. Each test is done more than three times.Figure 16
Pressure test of (a) chassis and (b) chassis installedBAM.
(a)(b)Two sets of comparative tests are conducted according to the following procedures. Under slope working conditions, the chassis is easy to roll over when the rear leg is in swing phase. Due to the symmetrical chassis structure, the pressure value change is only tested when the left rear leg is raised and the other three legs are in the supporting phase. The first set of pressure values is measured with a standard chassis, as shown in Figure16(a). Pressure values of the three supporting legs are obtained under the above slope conditions to be a control group. For comparison, the other set of pressure values with FC and BAM is measured and recorded to be test group, and the three parameters are taken as R = 120 mm, θa = 45 degrees, and σ = 45 degrees.The results are shown in Table4, and the standard chassis can be stable on a slope of 5 degrees, while the chassis installed barycenter adjustable mechanism can be stable on the slope of 15 degrees.Table 4
Test conditions and values.
TestInclination(°)ChassisChassis installedBAMV2 (mV)V3 (mV)V2′ (mV)V3′ (mV)1044538143236925845365522331310——634325415——795309Note.V2, V2′ are the plantar pressures of leg 2, and V3, V3′ are the plantar pressures of leg 3.The stability of a standard chassis and forestry chassis with BAM is compared by analyzing two groups of plantar pressure data. It shows that the plantar pressure of standard chassis’ leg 2 on the slope of 5 degrees is about 10 N and that of leg 3 is about 70 N. The contrastive value is 39 N for leg 2 of the chassis with BAM and 77 N for leg 3 on the same slope.The plantar pressure of the chassis with BAM is more significant than that of the standard chassis. The self-weight of the BAM is one reason to slightly increase the plantar pressure. The key reason is that the counterweight adjustment makes the barycenter of the chassis move to the support triangle, increasing the pressure of foreleg 2 to improve the chassis stability. As the slope becomes steeper, the plantar force of leg 3 increases and that of leg 2 decreases. On the slope of 15 degrees, the pressure of foreleg 2 is about 14 N and that of leg 3 is about 83 N. The results reflect that BAM is conductive to the chassis stability under slope working conditions.


## 4. Discussion

Our idea of chassis with BAM focuses on improving chassis stability by adjusting suitable barycenter positions. The chassis installed an adjustable counterweight, making the barycenter of the whole chassis system changeable so that the chassis can achieve a higher stability and climb the steeper slope. The scheme of the flexible structure is also adopted by other chassis, such as the schemes proposed by Paul A and Mosterman [27]. Differing from the wheeled type and large-scale equipment mentioned above, our manufactured prototype is small and lightweight, providing a role in limited working conditions under the forest. Hence, the legged structure is suitable for flexible operation and only four landing points are needed. Our chassis design with BAM has better adjustment performance, has low operator difficulty, and is more straightforward for manufacturing.Also, a high-precision bearing is used in the BAM, which helps the counterweight rotate smoothly; and two sets of high-precision microguide and slide are adopted to achieve lower friction translation. The structure design reduces assembly difficulty, so that the appropriate counterweight can be replaced according to the slope inclination.For BAM's barycenter curves, it is clear that the barycenter changes under the combined effect of three parameters. Rotation should be based on the translation. If the counterweight is at the center, rotation cannot change the barycenter position. While translation and vertical motion can change the barycenter, respectively, especially the vertical motion, it can effectively lower the height of the chassis barycenter even without translation and rotation. The counterweight can be reduced by up to 180 mm. According to stability NESM [28], the barycenter's lower height could be viewed as better stability. The barycenter stays in fixed point and near the geometric center is conducive to have smaller shaking and vertical fluctuation [29]. The more times and distance the barycenter adjust, the greater the chassis vibration and consumption. That is the reason why we adopt the intermittent static gait to disperse the vibration of the chassis caused by barycenter adjustment. In addition, the barycenter should adjust according to the terrain, and the distance of barycenter adjustment should be reduced on the premise of keeping the chassis stable. When the slope is gentle, minor adjustment is suitable. While on the steep slope, we choose the maximum stability margin of barycenter adjustment to improve the motion stability.Overall, it shows that the chassis with BAM is better than the standard chassis, especially for the barycenter position. As leg 4 is lifted, the former rolls over on a slope steeper than 5 degrees. The latter can be stable on a slope of 15 degrees, which is mainly affected by counterweight through changing the barycenter position. In theory, the chassis can keep stable on a steeper slope with a heavier counterweight. However, the heavier the counterweight is, the more torque the motor needs. Moreover, the friction between the foot end and the ground is also the factor affecting chassis stability. Thus, the heavier counterweights is not carried out in this paper.


## 5. Conclusion

In this paper, a forestry chassis with barycenter adjustable mechanism is proposed. According to the stability criterion of quadruped chassis, a control method is proposed to adjust the chassis barycenter by changing the parameters of counterweight to improve the chassis stability moving on the slope. The relationship between the range of counterweight displacement parameters (R, θa, and σ) and the barycenter position of the chassis is determined by mathematical analysis. The adjustment strategy is simulated in Adams, which realizes the barycenter adjustment. Finally, the test results show that the barycenter adjustable mechanism can adjust the chassis barycenter, and the motion stability of the chassis on a slope is improved. Through the test results analysis, the optimal adjustment of parameters is determined.



---

*Source: 5528746-2021-04-30.xml*