Optimizing for coordination with people - Robotics Institute Carnegie Mellon University