Toward Robots that Understand People and Their Environment