1. Field of the Invention
The present invention relates to robotics, and particularly to a target-seeking control method and system for mobile robots using relaxed field techniques to successfully guide the robot in known and unknown environments.
2. Description of the Related Art
Mobile robots have become indispensable in modern life activities. A considerable part of mobile robot activities involves operations in structured, predictable, even known environments (factory floors, warehouses, etc.). However, many applications require the robot to operate in unstructured and unknown environments. In extreme cases, such as first response in disaster areas, a mobile robot is required to provide informational access to the crew by going to the troubled spot in an unstructured and unknown environment as soon as possible. In such cases, the timely information the robot provides is probably more valuable than the robot itself.
This is a challenging problem, since all techniques designed for practical autonomous robots in unknown environments require an exploration and map-building stage before a robot can actually move to the required target zone. In a time-critical task, mandating a map-building stage in the manner an autonomous robot is required to function is self-defeating. Also, existing approaches designed for unknown environments require the robot to be equipped with a variety of expensive sensing capacities (e.g., laser scanners, omnidirectional cameras, etc.). This is highly undesirable in situations where the probability of retrieving the robot is low. Ultrasonic sensors are probably the most suitable choice, cost-wise, for such situations. However, there is a widespread belief in the area of autonomous robotics that ultrasonic signals are not useful for navigating robots in random unstructured environments with scattered irregular obstacles.
Thus, a target-seeking control method and system for mobile robots solving the aforementioned problems is desired.
The target-seeking control method and system for mobile robots uses a raw, ultrasonic sensory signal. The present method carries out reasoning and decision-making in a subjective environment (SE) on-board the robot. This environment has only two links to the objective environment (OE) in which the robot is operating. If the robot is at a safe place in a SE, then it is at a safe place in the OE. If the robot reaches the target in a SE, then it reaches the target in the OE. The present method uses relaxed potential fields to base enroute mobility on safety, only without having to accurately estimate the geometry of the surrounding environment, thereby significantly reducing structure complexity and increasing its reliability.
These and other features of the present invention will become readily apparent upon further review of the following specification and drawings.
Similar reference characters denote corresponding features consistently throughout the attached drawings.
The target-seeking control method for mobile robots uses a raw, ultrasonic sensory signal. The present method carries out reasoning and decision-making in a subjective environment (SE) 600a (shown in
The present method uses relaxed potential fields to base enroute mobility on safety, only without having to accurately estimate the geometry of the surrounding environment, thereby significantly reducing structure complexity and increasing its reliability.
While the use of scalar potential fields to aid robotic navigation is known in the art, the present target-seeking control method utilizes full and partial field relaxation procedures to relax the potential fields, thereby improving robotic navigation performance in both known and unknown environments. Typical motion equations of a velocity-controlled differential drive robot, such as the robot 300 shown in
The exemplary robot 300 is an X80 Pro manufactured by Dr Robot™ (Dr. Robot is a registered trademark of Dr. Robot, Inc. of Ontario, Canada). It has a distributed computation robotic architecture that enables high-level control of the robot to be maintained by a remote or local PC/server, such as exemplary computer 303, communicating by a secure wireless link, e.g., WIFI. Low-level functionality of the robot 300 is managed by an onboard digital signal processor (DSP), while computationally intensive operations are performed outboard by the exemplary computer 303.
The control signals (ωcR, ωcL) that are fed to the controller of the robot are generated by the control structure 100a, whose flowchart is shown in
In order to employ the relaxed potential fields, the present target-seeking control method performs an initialization stage. The glossary of symbols and abbreviations is provided in Table 1. The initialization stage is described in Table 2.
The full field relaxation stage is described in Table 3.
The process robot feedback stage is described in Table 4.
The record obstacle stage is described in Table 5.
The partial field relaxation stage is described in Table 6.
Full domain relaxation may be used after the above stage at highly reduced number of iterations L1<<L (e.g. if L=2000, L1=200).
The get guidance signal stage is described in Table 7.
The update robot variables stage is described in Table 8.
The generate control signal (GCS) stage is described in Table 9. The GCS system 100b is shown in
in a SE. An integrator block 110 is connected to the speed computation block 108 and computes the robot's position,
in a SE based on the robot's SE speed,
A guidance command block 112 accepts as inputs the robot's environment, the target's position, and the robot's position,
the guidance command block 112 outputting guidance signals, Gx, Gy.
Feedback to the desired angular speed computation block 105 includes a dot product of the guidance signals Gx, Gy and the robot's speed,
a cross product of the guidance signals Gx, Gy and the robot's speed,
the magnitude of the robot's speed
and the guidance signals, Gx, Gy. Feedback to the tangential speed computation block 102 includes a difference signal between the target position and the robot's position
The full and partial field relaxation stages assure that a robot can reach a target zone from the first attempt without the need for map-building. Moreover, the control structure can reliably utilize even one ultrasonic sensor to extract the necessary and sufficient information needed to navigate the robot in an unknown and unstructured environment. The aforementioned processing stages of the present target-seeking control method are fully autonomous. In other words, no external intervention by an operator is needed starting from the sensory signal from which the robot acquires information about the environment and ending with the control signal that is fed to the robot's actuator of motion (wheels' control speed). The aforementioned processing stages overcome problems associated with actuator saturation, sensor noise and limited computational capabilities.
The present method still allows operator input of available partial knowledge about the environment in the robot's database in order to expedite task execution. The control signal developed by the present method and fed to the actuators of the robot is a well-behaved continuous control signal, in contrast with prior art techniques for controlling nonholonomic robots (such as the differential drive robot), which use discontinuous control signals. A well-behaved control signal reduces the energy drain and the probability of actuator failure.
Additionally, the present method provides good performance, even when a very simple dead-reckoning localization procedure is used (i.e., robot position extracted by counting the number of time robots wheels turn). The structure can decouple the computational demands during the execution (hard-time) from the size of the workspace and make it proportional at an instant of time to the amount of environmental components (obstacles) that are discovered.
Plot 700 of
The ability of the “generate control signal” GCS stage 100b to convert the guidance signal to a control signal for the robot's wheels is shown in plot 900b of
The ability of the control generation stage to yield the needed control signals while the trajectory of the robot is being updated using the sensory feedback is shown in guidance plot 1000a of
The ability of the control structure 100a to generate motion for the X80 robot 300 from full information about the location of the obstacles is demonstrated in
The “not a priori known” start point and environment 1200 is shown in
Plot 1600b of
It should be understood by one of ordinary skill in the art that embodiments of the present target-seeking control method and system for mobile robots including control structure 100a and/or the GCS system 100b can comprise software or firmware code executing on a computer, a microcontroller, a microprocessor, or a DSP processor; state machines implemented in application specific or programmable logic; or numerous other forms, and is in operable communication with a robot, such as computer system 303 communicating with robot 300 for signal exchange between the processor, robotic drive components, robotic navigation components, and robotic sensor components without departing from the spirit and scope of the present invention. Moreover, the computer could be designed to be on-board the robot 300. The present target-seeking control method for mobile robots can be provided as a computer program, which includes a non-transitory machine-readable medium having stored thereon instructions that can be used to program a computer (or other electronic devices) to perform a process according to the methods. The machine-readable medium can include, but is not limited to, floppy diskettes, optical disks, CD-ROMs, and magneto-optical disks, ROMs, RAMs, EPROMs, EEPROMs, magnetic or optical cards, flash memory, or other type of media or machine-readable medium suitable for storing electronic instructions.
It is to be understood that the present invention is not limited to the embodiments described above, but encompasses any and all embodiments within the scope of the following claims.
| Number | Name | Date | Kind |
|---|---|---|---|
| 5758298 | Guldner | May 1998 | A |
| 20060293792 | Hasegawa | Dec 2006 | A1 |
| Entry |
|---|
| E. Prestes, M. A. P. Idiart, P. M. Engel and M. Trevisan, “Exploration technique using potential fields calculated from relaxation methods,” Intelligent Robots and Systems, 2001. Proceedings. 2001 IEEE/RSJ International Conference on, Maui, HI, 2001, pp. 2012-2017 vol. 4. |
| Gupta et al., “A network based, delay-tolerant, integrated navigation system for a differential drive UGV using harmonic potential field”, Decision and Control, 2006 45th IEEE Conference on. IEEE, 2006. |
| Gupta et al., “A delay-tolerant potential-field-based network implementation of an integrated navigation system”, Industrial Electronics, IEEE Transactions on 57.2 (2010): 769-783. |
| Habib, Maki K., and K. Maki. “Real time mapping and dynamic navigation for mobile robots”, International journal of advanced robotic systems 4.3 (2007): 323-338. |
| Masoud, Ahmad A. “A discrete harmonic potential approach to motion planning on a weighted graph”, American Control Conference, 2008. IEEE, 2008. |
| Masoud, Ahmad A., and Samer A. Masoud. “Evolutionary action maps for navigating a robot in an unknown, multidimensional, stationary environment. II. Implementation and results”, Robotics and Automation, 1997. Proceedings., 1997 IEEE International Conference on. vol. 3. IEEE, 1997. |
| Silva Jr. et al., “Exploration Method Using Harmonic Functions”, Robotics and Autonomous Systems, 40, 25-42, 2002. |
| Spenko, Matthew, et al. “Hazard avoidance for high-speed mobile robots in rough terrain.” Journal of Field Robotics 23.5 (2006): 311-331. |
| Thorpe, “Path relaxation: Path planning for a mobile robot”, OCEANS 1984. IEEE, 1984. |
| Number | Date | Country | |
|---|---|---|---|
| 20160257004 A1 | Sep 2016 | US |