Add Functions, cleaned up the code
Merge branch 'master' of https://github.com/ImmersiveSystems/net-robo