Improve efficiency (a little)

Remove some memory allocations. Add configuration files for simulator
and real robot.