Add method to get global robot pose to RobotStateMemory

Tested it with Python; it works and throws a useful exception if invalid robot name is given ;-)