A Simultaneous Localization and Mapping Algorithm in Complex Environments: SLASEM

In this paper we present an algorithm for the application of simultaneous localization and mapping in complex environments. Instead of building a grid map or building a feature map with a small number of the obstacles' geometric parameters, the proposed algorithm builds a sampled environment map (SEM) to represent a complex environment with a set of environment samples. To overcome the lack of one-toone correspondence between environment samples and raw observations, the signed orthogonal distance function is proposed to be used as the observation model. A method considering geometric constraints is presented to remove redundant environment samples from the SEM. We also present a method to improve the SEM's topological consistency by using corner constraints. The proposed algorithm has been verified in a simulation and an indoor experiment. The results show that the algorithm can localize the robot and build a complex map effectively.     

General Feature Extraction for Mapping and Localization of a Mobile Robot Using Sparsely Sampled Sonar Data

This study introduces a method of general feature extraction for building a map and localization of a mobile robot using only sparsely sampled sonar data. Sonar data are acquired by using a general fixed-type sensor ring that frequently provides false returns on the locations of objects. We first suggest a data association filter that can classify sets of sonar data that are associated with the same hypothesized feature into one group. A feature extraction method is then introduced to decide the exact geometric parameters of the hypothesized feature in the group. We also show the possibility of extracting a circle feature consistently as well as a line or a point feature by using the proposed filter. These features are then assembled to build a global map and applied to extended Kalman filter-based localization of the robot. We demonstrate the validity of the proposed filter with the results of mapping and localization produced by real experiments.     

An evolutionary algorithm for simultaneous localization and mapping (SLAM) of mobile robots

This paper presents a novel algorithm for simultaneous localization and mapping (SLAM) of mobile robots. The algorithm, termed Evolutionary SLAM, is based on an island model genetic algorithm (IGA). The IGA searches for the most probable map(s) such that the underlying robot's pose(s) provide(s) a robot with the best localization information. The correspondence problem in SLAM is solved by exploiting the property of natural selection, to support only better-performing individuals to survive. The algorithm does not follow any explicit heuristics for loop closure, rather it maintains multiple hypotheses to solve the loop-closing problem. The algorithm processes sensor data incrementally and, therefore, has the capability to work online. Experimental results in different indoor environments validate the robustness of the proposed algorithm.     

A Localization Algorithm for Autonomous Mobile Robots via a Fuzzy Tuned Extended Kalman Filter

The capability to acquire the position and orientation of an autonomous mobile robot is an important element for achieving specific tasks requiring autonomous exploration of the workplace. In this paper, we present a localization method that is based on a fuzzy tuned extended Kalman filter (FT-EKF) without a priori knowledge of the state noise model. The proposed algorithm is employed in a mobile robot equipped with 16 Polaroid sonar sensors and tested in a structured indoor environment. The state noise model is estimated and adapted by a fuzzy rule-based scheme. The proposed algorithm is compared with other EKF localization methods through simulations and experiments. The simulation and experimental studies demonstrate the improved performance of the proposed FT-EKF localization method over those using the conventional EKF algorithm.     

Design of a low-cost,highly mobile urban search and rescue robot

In this paper, we discuss the design of a novel robotic platform for urban search and rescue. The system developed possesses unique mobility capabilities based on a new adjustable compliance mechanism and overall locomotive morphology. The main facets of this work involve the morphological concepts, initial design and construction of a prototype vehicle, and a physical simulation to be used for developing controllers for semi-autonomous (supervisory) operation.     

Differential GPS and odometry-based outdoor navigation of a mobile robot

This paper describes outdoor navigation for a mobile robot by using differential GPS (DGPS) and odometry in a campus walkway environment. The robot position is estimated by fusion of DGPS and odometry. The GPS receiver measures its position by radio waves from GPS satellites. The error of GPS measurement data increases near high buildings and trees because of multi-path and forward diffractions. Thus, it is necessary to pick up only accurate DGPS measurement data when the robot position is modified by fusing DGPS and odometry. In this paper, typical DGPS measurement data observed near high buildings and trees are reported. Then, the authors propose a novel position correction method by fusing GPS and odometry. Fusion of DGPS and odometry is realized using an extended Kalman filter framework. Moreover, outdoor navigation for a mobile robot is accomplished by using the proposed correction method.     

Wrist Camera-Based Vibration Suppression Control for a Flexible Manipulator

This paper addresses a vision-based method for estimating vibration excited in the tip of a flexible-link manipulator. In this method, estimation of vibration is achieved by observing the variation of image features projected on a wrist camera. It mimics the situation of utilizing a wrist camera in tip vibration control of a space manipulator. In space, a vision sensor can be expected to be a feasible means for measuring the elastic vibration of the space manipulators, since they are more reliable compared with sensors like strain gauges. The method proposed in this paper takes advantage of the frequential characteristics of visual information that are reflected as a blurred background scene. With the high-frequency component of the projected image features, a Kalman filter-based observer is implemented as the estimator for the vibration. This implementation is characterized by the considerations of incorporating the slow sensor of the camera in the fast servo loop and compensation of the time delay due to image processing. With the vibration estimator, vibration suppression control relying solely on a wrist camera becomes possible. This scheme is successfully verified by experiments.     

Mobile robot tracking of pre-planned paths

A method of mobile robot steering control around pre-planned paths is presented. The system can maneuver accurately at low speeds by deriving control parameters as functions of vehicle velocity. The peak demand on the steering controller is reduced, by distributing steering curvature changes evenly over the extent of a maneuver.     

Efficient Simultaneous Localization and Mapping Based on Ceiling-View: Ceiling Boundary Feature Map Approach

For simultaneous localization and mapping (SLAM) based on the extended Kalman filter, the size of the state vector is an essential factor because the feasibility depends on it. In this paper, a new SLAM based on ceiling vision (cv-SLAM) is proposed. To keep the size of the state vector compact, the boundaries between ceiling and walls are used as landmarks for visual SLAM (vSLAM). The ceiling boundaries are robust to illuminative variations and they are not as numerous as the point features. Some constraints are imposed on the features based on the characteristics of the ceiling boundaries and an efficient update method called 'double update' is proposed to improve the SLAM performance. The basic idea of the double update is to fully utilize the intersections of the boundary features. Finally, the proposed SLAM is applied to some simulations and experiment, and its effectiveness is demonstrated through them.     

New Entropy-Based Adaptive Particle Filter for Mobile Robot Localization

Over the last decade, particle filters have been applied with great success to a variety of state estimation problem. The standard particle filter suffers poor efficiency during the estimation process, especially in the global localization and kidnapped problem. In this paper, we proposed a novel information entropy-based adaptive approach to improve the efficiency of particle filters by adapting the number of particles. The information entropy-based adaptive particle filter approaches use the information entropy to present the uncertainty of a mobile robot to the environment. By continuously obtaining the sensor information, the robot gradually reduces the uncertainty to the environment and, therefore, reduces the particle number for the estimation process. We derived the mathematic equation relating the information entropy with particle number. Extensive localization experiments using a mobile robot showed that our approach yielded drastic improvements and efficiency performance over a standard particle filter with fixed particles and over other adaptive approaches.     

Application of Genetic Algorithms for biped robot gait synthesis optimization during walking and going up-stairs

Selecting an appropriate gait can reduce consumed energy by a biped robot. In this paper, a Genetic Algorithm gait synthesis method is proposed, which generates the angle trajectories based on the minimum consumed energy and minimum torque change. The gait synthesis is considered for two cases: walking and going up-stairs. The proposed method can be applied for a wide range of step lengths and step times during walking; or step lengths, stair heights and step times for going up-stairs. The angle trajectories are generated without neglecting the stability of the biped robot. The angle trajectories can be generated for other tasks to be performed by the biped robot, like going down-stairs, overcoming obstacles, etc. In order to verify the effectiveness of the proposed method, the results for minimum consumed energy and minimum torque change are compared. A Radial Basis Function Neural Network is considered for the real-time application. Simulations are realized based upon the parameters of the 'Bonten-Maru I'humanoid robot, which is under development in our laboratory. The evaluation by simulations shows that the proposed method has a good performance.     

A roadmap construction algorithm for mobile robot path planning using skeleton maps

Path planning using conventional roadmaps, such as visibility graphs, probability roadmaps and skeleton maps, may have some disadvantages of long length, sharp turns or collisions with obstacles. Specifically, the paths using the conventional skeleton map have unnecessary turns around crossing points, which make longer paths and prevent the robot from moving smoothly. To improve the skeleton map, this paper proposes a new roadmap construction algorithm for path planning of a mobile robot using skeleton maps. The proposed algorithm alleviates the problems of the conventional algorithms by constructing roadmaps which consist of polygons around the crossing points. Simulation results show the efficiency of the proposed algorithm by comparing the results with those obtained using the conventional algorithm.     

Online Short-Term Multiple Sound Source Mapping for a Mobile Robot by Robust Motion Triangulation

The paper describes a two-dimensional (2-D) sound source mapping system for a mobile robot. The robot localizes the directions of sound sources while moving and estimates the positions of sound sources using triangulation from a short time period of directional localization results. Three key components are denoted. (i) Directional localization and separation method of different pressure sound sources by combining the Delay and Sum Beam Forming (DSBF) and the Frequency Band Selection (FBS) algorithms. (ii) The design of the microphone array by beam forming simulation to increase the resolution of the localization procedure and its robustness to ambient noise. (iii) Sound position estimation by using the RAndom SAmple Consensus (RANSAC) algorithm. Then we achieved 2-D multiple sound source mapping from time-limited data with high accuracy. Applying FBS as a binary filter after DSBF improves robustness for multiple sound source localization under robotic movement. In addition, a moving sound source separation method is shown by using segments of the DSBF enhanced signal derived from the localization process.     

Mobile robot with a self-positioning system

This paper describes a general method using configuration space for planning a collision-free path of a manipulator with 6 degrees of freedom (DOF). The basic approach taken in this method is to restrict the free space concerning path planning and to avoid executing unnecessary collision detections, based on the idea that a collision-free path can be planned using only partial information of the configuration space. The configuration space is equally quantized into cells, and the cells concerning path planning are efficiently enumerated based on a heuristic graph search algorithm. A heuristic function which characterizes the search strategy can be defined to give priority to the gross motion using the first few joints. A bi-directional search strategy is also introduced to improve efficiency. The memory is allocated only to the portion of the configuration space concerning path planning, and the data of the free space defined in the 6-dimensional configuration space can be efficiently stored. This algorithm of free space enumeration is independent of the kinematic characteristics of the manipulator. Therefore, this method is generally applicable to any type of manipulator. It has actually been implemented and has been applied to a 6-DOF articulated manipulator.     

Visual Odometry for a Hopping Rover on an Asteroid Surface using Multiple Monocular Cameras

Visual odometry refers to the use of images to estimate the motion of a mobile robot. Real-time systems have already been demonstrated for terrestrial robotic vehicles, while a near real-time system has been successfully used on the Mars Exploration Rovers for planetary exploration. In this paper, we adapt this method to estimate the motion of a hopping rover on an asteroid surface. Due to the limited stereo depth resolution and the continuous rotational motion on a hopping rover, we propose to use a system of multiple monocular cameras. We describe how the scale of the scene observed by different cameras without overlapping views can be transferred between the cameras, allowing us to reconstruct a single continuous trajectory from multiple image sequences. We describe the implementation of our algorithm and its performance under simulation using rendered images.     

Mobile robot localization using a self-organized visual environment representation

Owing to the upcoming applications in the field of service robotics mobile robots are currently receiving increasing attention in industry and the scientific community. Applications in the area of service robotics demand a high degree of system autonomy, which robots without learning capabilities will not be able to meet. Learning is required in the context of action models and appropriate perception procedures. In both areas flexible adaptivity is difficult to achieve especially when high bandwidth sensors (e.g. video cameras) - which are needed in the envisioned unstructured worlds - are used. This paper proposes a new methodology for image-based navigation using a self-organized visual representation of the environment. Self-organization leads to internal representations, which can be used by the robot, but are not transparent to the user. It is shown how this conceptual gap can be bridged.     

Mobile robot path planning using artificial bee colony and evolutionary programming

In this paper, an evolutionary approach to solve the mobile robot path planning problem is proposed. The proposed approach combines the artificial bee colony algorithm as a local search procedure and the evolutionary programming algorithm to refine the feasible path found by a set of local procedures. The proposed method is compared to a classical probabilistic roadmap method (PRM) with respect to their planning performances on a set of benchmark problems and it exhibits a better performance. Criteria used to measure planning effectiveness include the path length, the smoothness of planned paths, the computation time and the success rate in planning. Experiments to demonstrate the statistical significance of the improvements achieved by the proposed method are also shown.     

Environmental map building for a mobile robot using infrared range-finder sensors

This paper presents a methodology for building a high-accuracy environmental map using a mobile robot. The design approach uses low-cost infrared range-finder sensors incorporating with neural networks. To enhance the map quality, the errors occurring from the sensors are corrected. The non-linearity error of the sensors is compensated using a backpropagation neural network and the random error of readings including the uncertainty of the environment is taken into a sensor model as a probabilistic approach. The map is represented by an occupancy grid framework and updated by the Bayesian estimation mechanism. The effectiveness of the proposed method is verified through a series of experiments.     

Odor source localization using a mobile robot in outdoor airflow environments with a particle filter algorithm

This paper discusses odor source localization (OSL) using a mobile robot in an outdoor time-variant airflow environment. A novel OSL algorithm based on particle filters (PF) is proposed. When the odor plume clue is found, the robot performs an exploratory behavior, such as a plume-tracing strategy, to collect more information about the previously unknown odor source. In parallel, the information collected by the robot is exploited by the PF-based OSL algorithm to estimate the location of the odor source in real time. The process of the OSL is terminated if the estimated source locations converge within a given small area. The Bayesian-inference-based method is also performed for comparison. Experimental results indicate that the proposed PF-based OSL algorithm performs better than the Bayesian-inference-based OSL method.     

Position estimation of a mobile robot using images of a moving target in intelligent space with distributed sensors

Latest advances in hardware technology and state-of-the-art of mobile robots and artificial intelligence research can be employed to develop autonomous and distributed monitoring systems. A mobile service robot requires the perception of its present position to co-exist with humans and support humans effectively in populated environments. To realize this, a robot needs to keep track of relevant changes in the environment. This paper proposes localization of a mobile robot using images recognized by distributed intelligent networked devices in intelligent space (ISpace) in order to achieve these goals. This scheme combines data from the observed position, using dead-reckoning sensors, and the estimated position, using images of moving objects, such as a walking human captured by a camera system, to determine the location of a mobile robot. The moving object is assumed to be a point-object and projected onto an image plane to form a geometrical constraint equation that provides position data of the object based on the kinematics of the ISpace. Using the a priori known path of a moving object and a perspective camera model, the geometric constraint equations that represent the relation between image frame coordinates for a moving object and the estimated robot's position are derived. The proposed method utilizes the error between the observed and estimated image coordinates to localize the mobile robot, and the Kalman filtering scheme is used for the estimation of the mobile robot location. The proposed approach is applied for a mobile robot in ISpace to show the reduction of uncertainty in determining the location of a mobile robot, and its performance is verified by computer simulation and experiment.