2A2-M05 Behavior Planning Scheme for Exploration Robot based on Environment Understanding