ISePorto Robotic Soccer Team for Robocup 2009: Improving Perception.
Jose Almeida, Alfredo Martins, Eduardo Silva, Luís Lima, Carlos Almeida, Nuno Dias, Andre Dias, Hugo Silva
LSA - Autonomous System Laboratory Institute of Engineering of Porto Rua Dr Antonio Bernardino de Almeida 431 4200-072 Porto, Portugal
Abstract This paper presents the goals for the IsePorto Middle size team for Robocup 2009, and describe the major research efforts and achievements attained. Namely, this paper presents work done to improve team play capabilities and to deal with the current trend to increase the field size and the game dynamics, as well as, the research done in the ISePorto traction control system for wheeled mobile robots,in the vision system and the inertial navigation sensor integration in the self-localization.
1 Introduction
The ISEP Autonomous Systems Lab. (LSA) robotic football team provides an excellent tool to develop and demonstrate the research in the areas of interest associated with autonomous systems, like: sensor fusion, mobile robotics navigation, nonlinear hybrid feedback control, system architectures, coordination of teams of robots in dynamic environments, vision systems, and embedded systems.
The main goal for this year is keeping improving team play capabilities such as formation maneuvers and pass capabilities. The field size grow impose some additional requirements to perception and to the traction control. With the current trend to increase the game dynamics, the traction control issue takes an important role in order to achieve good levels of traction, and minimize the robot slippage improving the odometric information. Additionally an effort has been taken in order to increase the team reliability during games by improving some mechanical components.
In terms of game playing capabilities some coordination requirements need to be addressed. Partial mechanic redesign with emphasis on the kicker and ball control guides, are under development. This entails a kicker with ball force control, ball stopping mechanism and retractable ball guides. Multiple robot coordination also requires better perception. Efficient detection of player marks, goal edges and goal exposed area is also under active study and continuous development. A critical problem to be addressed by dedicated hardware under development, is the image latency and lack of determinism. In addition image resolution is increased with particular relevance for the kicker mounted camera.
The current trend to increase both field size and number of players implies that fewer measurements from absolute landmarks might be available for navigation due to both larger distances and more significant occlusion problems. These are the key issues motivating the use of additional sensors and research new localization and navigation methods. Concerning additional sensors, a low cost, small size (35x35x35 mm) inertial navigation system (INS) was introduced for robot heading and odometry slip correction. Additionally, vision field lines information are merged in the navigation filter providing better information of heading and position. With respect to new localization and navigation methods, one of the most promising avenues is to use teammates for collaborative localization and navigation. This approach entails additional complexity and requires a proper architecture enabling the arbitrage of conflicting objectives between control and navigation that may emerge.
2 Traction Control System
The concept of traction assume a preponderant role in the Robocup scenario caused by the robots are exposed to dynamic variations, like for example, changes in robot inertia, changes in center of gravity, variations in the friction between the surface and the wheels. This kind of variations will affect the traction properties and as a consequence it can occur situations of degradation of the motion and occurrence slipping[1][5].
For wheeled mobile vehicles the vast majority of work related to traction control systems relies in an a priori knowledge of the wheel-terrain interaction properties. However for many applications and in terrestrial mobile robotics in particular this information is not known apriori [2] [4].
In this work we study the problem of traction for a class of wheeled mobile robots. The robots have conventional wheels in a differential traction arrangement with electrical DC motors. The study of traction for this configuration used in the ISePorto Robocup MSL Soccer league robots has the advantage (in comparison with the more popular omnidirectional wheel MSL robots) of being applicable to many other land based robots (with conventional wheels).
The ISePorto traction control system has a capability monitoring applied torque and detect situations of slippage, blocked and pushing. Additionally, it has mechanisms to avoid the occurrence of slippage situations and to react to those situations when detected. Robocup MSL scenario provides both a good testbed and benchmarking scenario for the slip control and also induces novel control problems due to the stringent game robot performance.
2.1 Traction Control Hardware
The development of new power drives and motion controllers was motivated by the requirement of improving the traction control and the overall robot reliability, due to cabling simplification
The new axis control node DATCOS (Distributed Active Traction Control System), based on hybrid DSP with CAN interface (see figure 1), allows the reduction of the number of cables, providing torque measurements for traction control, is small sized, low powered, and provides computational capabilities supporting relatively sophisticated control algorithms such as slip, velocity and traction/force.
2.2 Traction System Architecture
This traction system is characterized by the capability of having two levels of action (see figure 2). The low level has a responsibly of reduce the occurrence of slip, optimize the torque applied to the motor and send via CAN all the information, continuous values and discrete events, that allow the high level control maneuvers to deal and adapt to the detected event. If we are capable of interpreted the problems it will be possible to correct and adapt the path [6].
The solution of having a distributed active traction control system allows the improvement of the response time of electric motor torque in each wheel.
2.3 Characterization the of traction problems in the Middle Size League
In a Middle Size game the robots are exposed to dynamic variations of the adherence [1] values between the surface of the middle size field and the wheels caused by events like pushing, blocked, collisions and crossing the lines of the field. All this perturbations can be observer in the current and velocity value in each wheel (see figures 3 and 4).
3 Inertial navigation system (INS)
The ISePorto INS is composed by a ARM7 LPC2129 with CAN interface, a triaxial accelerometers LIS3LV02 from ST, a gyroscopes CRS10 from Silicon Sensing and a 3-axis magnetic field sensing module MicroMag from PNICorp.(see figures 3).
Using the measurements from the INS we can calculate the velocity, position and heading of the robot starting from some known initial point. This means that INS does not depend on any third party applications, like other type of sensor, and thus will always work regardless of external influences, however, the accuracy of the INS degrades with time (tend to drift exponentially from the true values) due to measurement inaccuracies, double integration from acceleration to position, collisions between robots and magnetic field. The robot self-localization in the game field will be obtained from the data fusion between vision landmarks information and the INS measures, resulting in a global game improvement.
4 Kicking Device
The kicking device was development with the main propose of having and improvement not only in the shooting process but special the pass ability between the team players. With the field size increase, the cooperative and behavior algorithms implementation in the game the robots are now capable to receive and pass the ball between them. To sustain this it was development a shooting device with force control and retractable ball guides. The kicking device has two loops of control: position and force control. The position control is responsible to ability the kicker to receive the ball, stop and prepare to pass, the force control loop will be applied in the kicking and the pass between teammates.
5 Vision System
The ISePorto vision system is based on a real-time vision architecture (LSAVision) for mobile robotics. This vision system is characterized by: low computational cost, low latency, low power, high modularity, reconfigurability, adaptability and scalability. A pipeline structure further reduces latency and allows a paralleled hardware implementation.
A dedicated hardware vision sensor (BOAVISTA) was developed in order to take advantage of LSAVision architecture. The hardware embedded sensors are an emergent solution in robotics and autonomous systems applications. This is due to their hardware reconfiguration capabilities, their also a low cost implementation, with low energy consumption and low hardware concentration.
Our embedded vision sensor allows 60 fps at VGA resolution, image processing starts in an early stage of image acquisition allowing overall image latency to be less than 500 us.
This vision sensor can also use different image sensors with a higher frame-rate, resolutions and High Dynamic Range Image capabilities for use in outdoors applications.
However, due to the improvement of kicking mechanism devices in most of the MSL Robocup Teams, this year we will present a novelty in our vision system by integrating a vision stereo device system based in two IDS UI 1235LE-C , capable of acheving 68 fps at WVGA resolution. Our goal is to improve overall robot perception especially what concerns the goalkeeper, in order to extend the ability to defend high placed kicks.
6 Conclusions and Future Work
Current developments in the design and implementation of the traction control, vision, control and navigation subsystems of the robotic soccer team ISePorto are presented. Much research and development effort is taken towards the goal of multiple robot coordinated play. Additional team improvements were made to increase game operation ranging from mechanical kicker device developments to a new traction control system. The implemented vision system provides an efficient edge and blob identification achieving real-time determinism of field lines and relevant objects used in navigation, coordination and obstacle avoidance. A dedicated hardware vision sensor is currently being integrated in the robots to decrease both image latency and computational costs, and provide much higher precision in the raw vision measures. The team has participated in several competitions namely in the Robocup 2003, Robocup 2004, Robocup 2006, GermanOpen 2002, 2003, 2005 and 2008, Robotica 2002, 2003, 2004, 2005, 2006, 2007 and 2008 in Portugal, with good results The test of the new integrated features needs to be validated in game conditions in Robocup 2009 competition.
7 Acknowledgement
The authors would like to thank the LSA team for their efforts and dedication in developing the robots and support on the participation of competitions and events. This work is sponsored by IPP and ISEP. The BoaVista Project is founded by the Portuguese Science and Technology Foundation of Ministry of Science and Technology.
References
- Andre Dias, José Miguel Almeida, Alfredo Martins, Eduardo Silva. Traction characterization in the Robocup Middle Size League. IEEE Robotica 2007 - 7th Conference on Mobile Robots and Competitions, Paderne, Portugal, 2007.
- Yasushi Toyoda Yoichi Hori and Yoshimasa Tsuruoka. Traction control of electric vehicle: basic experimental results using the test ev uot electric march. IEEE Transaction on Industrial Applications, 34(5):1131–1138, 1998.
- H Olsson. Control Systems with Friction. PhD thesis, Institute of Technoloy, 1996.
- Albagul A. Dynamic Modelling and Control of a Wheeled Mobile Robot. PhD thesis, University of Newcastle upon Tyne, 2001.
- Shiller, Z. F.L: Dynamics Motion Planning of Autonomous Vehicles, IEEE Trans. on Robotics and Automation Vol. 7,No.2,1991
- Kiam Heong Ang and Chong, G. and Yun PID control system analysis, design, and technology (eds.) Control Systems Technology, IEEE Transactions on Understanding Vol. 13, No. 4, JanuaryJuly, pp. 559-576, 2005.
- Lima, L., Almeida, J.M, Martins, A., Silva, E.P: Development of a dedicated hardware vision system for mobile robot navigation, Robotica 2004 International Conference.
- Martins, A., Almeida, J.M, Silva, E.P, Pereira, F.L: Vision-based Autonomous Surface Vehicle Doccking Manoeuvre, MCMC2006 7th IFAC Conference on Manoeuvring and Control of Marine Craft, Lisbon, Portugal, September 2006.
- Martins, A., Almeida, J.M, Silva, E.P, Santos, F., Bento. D: Forest Fire Detection with a Small Fixed Wing Autonomous Aerial Vehicle, submitted to IAV 2006
- Almeida, J.M, Martins, A., Silva, E., Baptista, J., Patacho, A., Lima, L., Cerqueira, V., Almeida, C., Picas R. ISePorto Robotic Soccer Team for Robocup 2003, In: RoboCup 2003 Int. Symposium, Padua, Italy.