Add an example of a more advanced robot for HTF

Improve utils