# Geometry Based Approach to Obstacle Avoidance of Triomnidirectional Wheeled Mobile Robotic Platform

Authors: Tesfaye Wakessa Gussu; Chyi-Yeu Lin
Journal: Journal of Sensors
 (2017)

---

## Abstract

Mobile robots undergo a collision-free autonomous motion by using the information obtained from a suitable combination of multiple sensors of same or different families. These sensors are often configured around the chassis of the robotic platform. However, little to no information is available as to how these sensors are configured on mobile robotic platforms and how many of these sensors to place on such platforms. Instead, an empirical approach is adopted. That is, the number of sensors of the same family or any type as well as combination of sensors for detecting obstacles is determined by experiment or information obtained from external sensors. This approach is often seen to be iterative and time consuming. In this paper, an approach for determining the minimum number of sensors and their spacing on the robotic platform is proposed so that mobile robots undergo collision-free motion. The effectiveness of the developed approach is experimentally tested by examining the obstacle avoidance capability of the triomnidirectional wheeled robotic platform based on a motion triggering signal obtained from a skirt of ultrasonic sensors only. It was observed that the newly developed approach allows this robotic platform to avoid obstacles effectively.


---

## Body

## 1. Introduction

Mobile robots are developed to perform a purposeful task by traversing through their working zone with little to no human intervention. Hence, their usefulness depends on the ability to achieve the set sequence of operations entailed to them while traversing safely in both structured and unstructured environments. However, they are unable to function properly in such environments unless they have efficient sensing and predicting capabilities and thus require a sensor fusion system [1] to extract useful information from their environment. Thus, making a precise planning before moving the robots is often seen failing since these changes are rarely predictable or perfectly known. Therefore, bridging this gap and executing the set tasks require knowing their environments and avoiding obstacles by using local information and obstacle detecting sensors. In order to perform collision-free motion or a defined task, a combination of one or more sensors of the same or different type is often used in most autonomous robotic platforms. However, such fused sensor system is either complementing each other or being redundant most of the time.An online obstacle avoidance method for the holonomic circular robot is presented in [2]. This navigation system combines perception and dead reckoning by fusing 24 ultrasonic sensors and wheel encoders and the algorithm for motion planning is modified online based on the recorded positions of the obstacles. However, the basis on which the fused sensors and their spacing around the developed robotic system are determined was not specified.In [3], rangefinder sensors are used to generate a collision-free path and guide the robot towards the goal and keep it away from obstacles through the directive circle method. The position and velocity information of static or dynamic obstacles are obtained using these sensors. However, as presented in [4], such sensors experience poor directionality depending on the distance to the obstacle and the angle between the obstacle surface and the acoustic beam. These sensors are also pruned to frequent misreadings caused by ultrasonic sensor noise or cross-talk. In such scenarios, the robot may start to misbehave or collide with obstacles unless the misreadings and cross-talk are filtered.As presented in [5], a combination of ultrasonic sensors, contact switches, and a modular sonar camera that is always swinging is used to complement the ultrasonic sensor for avoiding the obstacles in an autonomous mode. The robot velocities are taken to be a function of distance to obstacles and the ultrasonic sensor works at its full scanning range. For this case, a safe minimum distance is imposed on the linear speed of the robot. This is due to the fact that obstacle avoidance using ultrasonic sensors involves local scanning of the robot environment, local mapping containing information about the obstacles, and the action to be taken by the robot.A neural control system embedded in Arduino platform is presented [6] to perform obstacle avoidance in real time using the information obtained from the ultrasonic sensors. This complex decision-making strategy is implemented in MATLAB and processing environment. Although such approach allows the robot to learn the nonlinear relationships between the sensor readings and the control inputs, system level complexity is greatly reduced; they are computationally involved. Furthermore, such realization may require more ultrasonic sensors and additional sensors such as gyroscope, wheel encoder, and other methods to extract further position information of the robot.A fuzzy logic controller that generates an instantaneous collision-free motion is presented in [7, 8]. Obstacle avoidance capabilities are achieved through online planning wherein the planner receives a continuous flow of information about occurring events and generates a corresponding command in response to the events. Although this approach allows obstacle avoidance in dynamic environments as well, it is not effective if the environment is changing unexpectedly. A pair of the obstacle detecting sensors is used to extract useful information about the surrounding environment [9]. Although these sensors give updated information about the surrounding environment and the relative position of the obstacle, a joystick is used as motion assistant to induce scanning. An obstacle detection technique that uses combination of Kinect and sonar sensor is used for estimating the pose of moving obstacles [10]. Although this technique improves the accuracy and robustness of the reactive motion planning approach in uncertain dynamic environments, the fused sensors are empirically dependent on each other.According to fuzzy obstacle avoidance and Elman Neural Network (ENN) algorithm proposed in [11], a virtual force field is used to keep the mobile robots away from the obstacles by the desired distance. Since this approach is subjected to uncertainties, an Elman Neural Network is proposed to compensate for the uncertainties between the moving robot and the obstacles. However, the exact distance to the obstacles is still difficult to obtain. Thus, computationally involving Elman fuzzy adaptive controller is used to adjust the distance to an obstacle.Furthermore, navigation and obstacle avoidance capabilities of mobile robotic platforms strongly depend on the performance of ultrasonic sensors and the fused sensor system in most of the cases. As a result, ring of sensors forming a skirt is often used. Despite all these efforts, mobile robots often lack the ability to avoid obstacles completely and fail to perform autonomously. This unsatisfactory collision-free autonomous operation of mobile robots is mainly due to an empirical approach implemented for determining the type and number of sensors to be used on the mobile robotic platforms.In this paper, a new geometry based obstacle avoidance approach is presented. This approach explicitly presents the geometrical dependency of a family of distance to obstacle measuring sensors (specifically ultrasonic sensors) and their reading outputs with the geometry of mobile robot chassis. The safe distance to obstacle obtained from this geometrical relationship is a function of the sensor readings in centimeter and is mainly used as motion triggering signals for obstacle-free motion. Furthermore, it allows determination of the minimum number of sensors and the spacing strategy on the mobile robotic platforms. Then, the effectiveness of the developed approach is examined on triomnidirectional wheeled mobile robotic platform traversing in an unstructured environment.


## 2. Sensor Spacing and Skirting Strategy

The geometrical shape of wheeled mobile robot base can assume any shape as shown in Figure1(a) and the configuration of sensors on such robots also varies accordingly. Despite such variations, obstacle-free motion and set task execution will be compromised unless they are equipped with properly and optimally spaced sensors of the same type or fused sensors. Hence the closeness of the predicted real world state to its actual state can greatly affect the way the mobile robots are behaving and responding to the changes in their surroundings.Figure 1
Possible mobile robot configurations, sensor spacing strategy, and safe distance determination.
(a)
(b)Although it is a common practice to see mobile robots having several ultrasonic sensors placed on their chassis, there are no clear methodologies for determining the number of ultrasonic sensors and the spacing from each other. Instead, an empirical approach is adopted. This may result in interference of the readings if the sensors are placed very close to each other or loss of information if less number of these sensors is used. In this paper, two approaches are proposed to determine the number and spacing strategy of ultrasonic sensors on the triomnidirectional wheeled mobile robotic platform with circular chassis shown in Figure1(b). The first approach involves the following:(i)
Fixing the number of ultrasonic sensorsN and θ1. Irrespective of the application dependent configuration of mobile robotic chassis, this approach assumes that two sensors are placed on the opposite sides of the wheels and at an angle θ1 from the center of the wheels. The remaining ultrasonic sensors are arranged between the three wheels at angle θ from each other. Hence the spacing angle θ is determined such that interference problem is avoided.The second approach involves the following:(i)
Fixingθ and θ1 and determining the number of ultrasonic sensor N. This approach also ensures that interference is completely avoided as long as the object is far away from the robotic platform at least by distance RS.In most practical scenarios, despite their ideal working range of90°, the reading accuracy of these sensors starts to deteriorate when the angle formed by emitted sound and echo wave exceeds 60°. This shows that the dependency of the spacing angles θ and θ1 is affected by the number of sensors N. Using too closely spaced N sensors may create interference and cross-talk and sparsely configured N sensors result in missed sensor readings. Thus, the analysis given below assumes that the sensors are configured at a radial distance of RS such that cross-talk and interference are eliminated. Assuming the robotic platform is subjected to detectable object, RS is determined geometrically as shown in Figure 1(b). Therefore, the minimum safe distance for which the ultrasonic sensor yields noninterfering reading is the magnitude of the line formed by connecting the center of the wheelbase to the intersection point of the lines drawn at an angle of 135° from the respective axis of adjacent ultrasonic sensors. Its value is dependent on the number of ultrasonic sensors N and the radius of the circular chassis R. Hence, the relationship between N and the circumference of the circular chassis is defined as(1)2πR=aNL+3S1+N-3S2.The valuea is a correction factor for the approximated arc length defined by the product of N and the ultrasonic sensors length L. S1 is the circumferential distance intercepted by ultrasonic sensors that are configured adjacent to each wheel and S2 is the circumferential distance intercepted by any two consecutive ultrasonic sensors presented as follows:(2)S1=πr1θ1180°,S2=πrθ180°.Substituting (2) into (1) and solving for θ yields(3)θ=2πR-aNL180°-3πr1θ1N-3πr.For the given configuration,(4)θ+θ1=60°.Substituting (4) into (3) and solving for θ yields(5)θ=2πR-aNL-πr1180°πN-3r-3r1.Equation (5) yields the angular spacing of the sensors on the circular chassis of the mobile robotic platform in degree. However, the following equation must be satisfied all the time:(6)N-33>r1r.The valuesr and r1 are determined by geometrical analysis from 3D CAD model of the mobile robotic base or the platform chassis as shown in Figure 1 or by measuring the position of the wheels and the ultrasonic sensors with respect to the origin of the robotic platform chassis. Therefore, depending on the measured value of r and r1, the minimum number of ultrasonic sensors N and their relative positions with respect to each other will be determined with ease.


## 3. Obstacle Avoidance System Design

The distance measuring accuracy of ultrasonic sensors greatly affects the capability of the mobile robotic platform in avoiding obstacles. Generally, Figure3(a) shows that ultrasonic sensors cannot give an accurate reading if the obstacles are farther than a distance d0 as per the manufacturer’s specification or the object is at a distance less than RS. The reading can also be affected if the obstacle has a reflective surface at a shallow angle greater than 45° as shown in Figure 3(b). This happens because the sound wave will not be reflected to the sensor properly. The obstacle can either be missed or too small sound reflects to the receiver if the obstacle is too small and too soft as in the case of Figures 3(c) and 3(d), respectively. Ultrasonic sensor may also detect sounds reflecting off the floor if it is mounted close to the floor of the robotic platform.By implementing sensor spacing method explained in approach 1, a combination ofN=9 and θ1=22.5° is chosen. As an example, the configuration of the nine sensors, the robotic platform chassis, and obstacle around it is shown in Figure 2(a). In this approach, a normal distance is drawn from the contact point of the emitted wave with the obstacle to the y-axis. These normal distances are denoted by d1 to d8 and determined by applying similarity of triangles. For example, the distances d1 and d1′ to obstacle 01 are determined from of triangles with vertices o, o1, po and o, o2, p1 in Figure 2(a). Given the sensor reading values, the normal distances are determined as follows:(7)loy=d1d1′,y=RScos⁡θ+θ1,lo=R-w-cm0-RScos⁡θ+θ1,d1′=RSsin⁡θ+θ1.Figure 2
Ultrasonic sensor configuration and coordinate transformation of a robotic platform with circular chassis.
(a)
Ultrasonic sensor configuration
(b)
Platform global and local coordinate frameFigure 3
Effect of type and orientation of obstacles on the response of ultrasonic sensors.
(a)
Working principle of Ping Ultrasonic Sensor
(b)
Flat obstacle at angle to Ping Ultrasonic Sensor
(c)
Too small obstacle in front of Ping Ultrasonic Sensor
(d)
Too soft obstacle in front of Ping Ultrasonic SensorApplying sensor spacing approach 1 and (3), θ=37.5° for a=0.68. Hence, θ1=22.5°. Obtaining R=0.33m and RS=0.666m from the geometry shown in Figure 1(b) and simplifying (7), the normal distance d1 is expressed as a function of the reading from the corresponding sensor and is given as(8)d1=R-w+cm0-RSsinθ+θ1.Similarly, the distances to obstaclesd2 to d8 are shown as follows:(9)d2=R-w+cm1-RSsin⁡θ1,d3=R-w+cm2-RSsinθ1,d4=R-w+cm3-RSsin⁡θ+θ1,d5=R-w+cm4sinθ+2θ1,d6=R-w+cm5sin⁡θ,d7=R-w+cm7sin⁡θ,d8=R-w+cm7sin⁡2θ.The normal distancesd2′ to d8′ and l3, l5, and y are obtained as follows: d2′=RSsin⁡(θ1), d2′=d3′, d4′=RSsin⁡(θ+θ1), d5′=RSsin⁡(2θ), d6′=RSsin⁡(θ), d7′=d6′, d8′=d5′, l3=cm0-cm1cos(θ1), l5=[cm[5]-cm[7]]cos(θ1), and y1=R-w+cm[6]-RS.The sensor reading ofcm[0] to cm[8] is gathered and stored in the form of an array by following the flowchart shown in Figure 5. Ten states of the robotic platform are chosen for the nine ultrasonic sensors and a value of 1 and 0 is assigned to each sensor for indicating the presence and absence of an obstacle, respectively. To examine the response of the mobile robotic platform to the presence of obstacles, a set of state-obstacle-sensor-actions is developed as shown in Table 1. The path for avoiding these obstacles is selected based on the converted analog signal into digital value [12] of the ultrasonic sensors. Thus, the robotic platform takes the corresponding actions as indicated in Table 1 and the motion directions shown in Figure 4.Table 1
Binary representation of sensors for different robotic platform state.
State
Obstacles
Ping sensors
Action
9
8
7
6
5
4
3
2
1
0
1
2
3
4
5
6
7
8
9
0
0
0
0
0
0
0
0
0
Spin/rotate
1
2
3
1
1
1
1
1
1
0
0
1
Move withVS
2
1
9
0
1
1
1
1
1
1
1
0
Move withVE
3
1
2
9
0
1
1
1
1
1
1
0
0
Move withVSE
4
4
5
1
1
1
1
0
0
1
1
1
Move withVW
5
4
5
6
1
1
1
0
0
0
1
1
1
Move withVNW
6
5
6
7
1
1
0
0
0
1
1
1
1
Move withVN
7
8
9
0
0
1
1
1
1
1
1
1
Move withVNE
8
3
4
5
1
1
1
1
0
0
0
1
1
Move withVSW
9
None
1
1
1
1
1
1
1
1
1
Arbitrary directionFigure 4
Motion directions.Figure 5
Sensor data generation sequence.


## 4. Kinematic Equation of Triomnidirectional Wheeled Robotic Platform

The kinematic modeling of the robotic platform is carried out based on the design and operational assumptions presented in [13]. The rotation direction of the angular velocity of the wheels attached to the mobile robotic chassis is about a3, b3, and c3, respectively. R is the radius of the circular chassis of the robotic platform and α1, α2, and α3 are the orientation angles of the wheels with respect to the coordinate frame (x,y) of the robotic platform chassis. Taking α1=90°, α2=210°, and α3=330°, the unit vectors attached to the wheel’s geometric center take the values given in Table 2.Table 2
Magnitude of the unit vectors.
a
1
a
2
a
3
b
1
b
2
b
3
c
1
c
2
c
3
x
−1
0
0
1
2
0
√
3
2
1
2
0
-
√
3
2
y
0
0
−1
-
√
3
2
0
1
2
√
3
2
0
1
2
z
0
−1
0
0
−1
0
0
−1
0This robotic platform chassis uses three symmetrically aligned omnidirectional wheels with rollers configured at90° to its axis. The velocity of each wheel is measured by an encoder attached to the motor that actuates each wheel. The rollers on the wheels are self-accommodating since they are neither sensed by encoders nor actuated by motors [14]. The vector sum of the tangential velocities of the three wheels on the robotic platform is given as follows:(10)Vp→=V1→+V2→+V3→,where,(11)V1→=ω1a3→×rwa2→=-ω1rwa1→,V2→=ω2b3→×rwb2→=-ω2rwb1→,V3→=ω3c3→×rwc2→=-ω3rwc1→,where ω1, ω2, and ω3 are the angular velocities of the three wheels, respectively. Vp→ of the robotic platform is expressed in (10) and is further simplified in (12) as a function of the rotational and the (x,y) component of the velocities of the robotic platform about its geometric center.(12)Vp→=a11b11c11R-bw2φ˙c˙.The relationships between the velocity of the robotic platform and the wheel velocities are obtained by computing (12) with (10), yielding the following:(13)-rw100010001ω1ω2ω3=a11b11c11R-bw2φ˙c˙.The wheel angular velocitiesω1, ω2, and ω3 are obtained from (13). Equation (14) shows the wheel’s angular velocities in terms of the robotic platform velocity (φ˙,x˙,y˙) and its radius (R), the wheel width bw, and the wheel radius rw.(14)ω1ω2ω3=1-rwR-bw2-10R-bw212-32R-bw21232φ˙x˙y˙.Since the developed robotic platform uses Swedish wheels, there is no sliding constraint and the movement orthogonal to the wheels is free due to the rolling of the small rollers. Hence (14) is taken as the rolling constraint [15] imposed by the three wheels. Therefore, only ω1, ω2, and ω3 of each wheel are controllable and obtainable by substituting the robot velocity components x˙=VPcos⁡Ø, y˙=VPsin⁡Ø, the wheel radius rw=0.0625 m, wheel width bw=0.038 m, and platform radius R=0.33 m into (14). This yields the angular velocities of the three wheels as expressed in terms of the robot velocity VP and its orientation angle Ø. In addition, Algorithm 1 was used to ensure the correct wheel direction of rotation.Algorithm 1:Method of correcting wheel rotation direction.
for  i=1; i≤3; i++  do
compute each wheel speedωi
if  ωi>0  then
wheelispeed=ωi
else if  ωi<0  then
wheelispeed=-ωi
else
wheelispeed=0
end if
end for


## 5. Experimental Validation of the Proposed Method

An experimental setup consisting of a triomnidirectional wheeled robotic platform shown in Figure6(a) is developed to validate the effectiveness of the proposed approach for obstacle avoidance application. The setup uses a low-level PID controller whose gains are tuned in real time by using Faulhaber motion manager software for Faulhaber motor(Series of 3863H024CR with Gearhead of 38 A Series and 24 V Motor Winding voltage) and motion controller series(MCDC3006S RS). The system uses TTL to RS232 converter for data transferring between Arduino Mega 2560 microcontroller and Faulhaber motion controller series. A skirt of 9 PING)))™ Ultrasonic Sensors is used for detecting and avoiding obstacles while moving according to the motion directions defined in Figure 4.Figure 6
Experimental setup of the robotic platform for obstacle avoidance test.
(a)
Prototype of the mobile robotic platform
(b)
Experimental setup for obstacle avoidanceThe robustness of the developed approach is examined by varying the orientation and motion directions of the robotic platform while maintaining the three wheel orientations atα1=90°, α2=210°, α3=-30°, and β1=β3=β3=0°. Table 3 shows the possible combinations of the platform orientation and the corresponding motion directions. The triggering signal presented in this table is a combination of the individual sensor reading values expressed in terms of the robotic chassis geometry and its physical dimensions.Table 3
Robotic platform orientation, motion directions, and triggering signals.
Orientation
Motion directions
Motion triggering distance
Ø
=
0.5
π
V
=
V
N
y
≤
0
Ø
=
-
0.5
π
V
=
V
S
L
3
≤
0
Ø
=
π
V
=
V
W
d
3
≤
d
3
′
Ø
=
0
V
=
V
E
d
8
≤
d
8
′
Ø
=
0.833
π
V
=
V
N
W
d
6
≤
d
6
′
Ø
=
0.333
π
V
=
V
N
E
d
7
≤
d
7
′
Ø
=
1.333
π
V
=
V
S
W
d
4
≤
d
4
′
Ø
=
-
0.333
π
V
=
V
S
E
d
1
≤
d
1
′


## 6. Result and Discussions

A new geometry based obstacle avoidance method is proposed in this work. This approach involves obtaining the position of an obstacle with respect to the robotic platform through scanning and mapping of local environment by using a skirt of PING))) Ultrasonic Sensors only. A method by which the geometry of the robotic platform chassis is related to the physical dimensions of the sensors and their corresponding distance measurement outputs is developed. Thus, the minimum number of these sensors and their configuration around the chassis of the robotic platform is determined. In this approach, explicit formulation assumes that at least two sensors are placed on the opposite side of each wheel at an angle of22.5° from the wheel axis and the intermediate sensors are spaced at an angle of 37.5° from each other. The developed approach is validated by using the kinematic model of the triomnidirectional wheeled robotic platform with circular chassis. The three wheels on this robotic platform are configured at a radial distance of (R–dw/2) from its geometric center and are driven by three Faulhaber motors(Series of 3863H024CR with Gearhead of 38 A Series and 24 V Motor Winding voltage). Each motor has a gearhead with a reduction ratio of 16 : 1 and an IE2-1024 magnetic encoder and is controlled by a Faulhaber motion controller series(MCDC3006S RS). The motion of this robotic platform is controlled using low-level PID controller that is tuned in real time. Laptop PC is used as a central processing unit and the motion controller(MCDC3006S RS) is connected to TTL to RS232 converter to receive the speed, orientation, and the ultrasonic sensors reading outputs from Arduino Mega 2560.Finally, the robustness of the developed approach is evaluated by allowing the robotic platform to traverse across the randomly placed obstacles as shown in Figure6(b). This robotic platform continues moving along its default motion direction VN until it encounters an obstacle and detours away from it according to the wheel kinematic equations and geometry based triggering signals shown in Table 3. Table 4 shows the evaluation results collected by starting over the robotic platform motions five times and examining its obstacle avoidance capabilities in each test. The detouring capability of this platform was controlled by following the direction of the arrows drawn on the top cover of the robotic platform as shown in Figure 6(b).Table 4
Obstacle avoidance test of the robotic platform based on geometry based triggering distances.
Motion direction
Motion direction
Motion direction
Motion direction
Triggering signal
Default
Triggering signal
V
S
Triggering signal
V
W
Triggering signal
V
E
Test number
Evaluation
Test number
Evaluation
Test number
Evaluation
Test number
Evaluation
1
●
1
⊗
1
●
1
●
2
●
2
●
2
●
2
×
Y
≤
0
3
●
L
3
≤
0
3
●
d
3
<
d
3
′
3
●
d
8
<
d
8
′
3
●
4
●
4
●
4
⊗
4
●
5
●
5
×
5
●
5
⊗
Triggering signal
V
N
W
Triggering signal
V
N
E
Triggering signal
V
S
W
Triggering signal
V
S
E
Test number
Evaluation
Test number
Evaluation
Test number
Evaluation
Test number
Evaluation
1
×
1
×
1
●
1
●
2
●
2
●
2
●
2
●
d
6
<
d
6
′
3
●
d
7
<
d
7
′
3
●
d
4
<
d
4
′
3
●
d
1
<
d
1
′
3
●
4
●
4
⊗
4
×
4
⊗
5
●
5
●
5
●
5
●
● Completely avoids obstacles.
⊗ Closely clears obstacle.
× Collide.This robotic platform was seen to completely avoid obstacles for 77.5% of the test cases. It was also seen to clear the obstacles for more than 90% of the test cases. Hence, the robotic platform collides with the obstacles for less than 10% of the test cases. This is mainly because the configurations of the ultrasonic sensors on the robotic platform were above the height of the smallest obstacle along its motion directions. Although this robotic platform can clear obstacles for most of the test cases, its robustness was not examined in terms of path correction and go-to-goal application.


## 7. Conclusions

In this paper, a new geometry based obstacle avoidance technique is developed. This technique mainly used a skirt of ultrasonic sensors that are configured on the chassis of the triomnidirectional wheeled robotic platform. The effectiveness of this approach is validated by studying obstacle-free motion capability of the robotic platform for different maneuverable modes. In this work, the motions triggering signals were obtained by relating the geometry of the robotic platform chassis, ultrasonic sensor physical dimension, and its readings outputs. It was observed that the robotic platform was seen to avoid obstacles autonomously with higher mobility with instant sensor reading outputs for most of the test cases. This eliminates the need for taking multiple sensor readings that often requires averaging. The new technique also eliminates the need to rely on external sensor information as it enables the robotic platform to clear obstacles that are very close. Therefore, this approach can be implemented on mobile and service robots that involve close range obstacle avoidance.



---

*Source: 2849537-2017-04-11.xml*