Interaction aware and active perception algorithms

Summary
Corresponding to all tasks.