Mapping And Planning For Safe Collision Avoidance On-Board Micro-Aerial Vehicles