Environment and Intention Awareness for Navigation and Collaboration