Code update

I made the functions work, added another snippet for a new auto program.
Wont compile anymore, but a lot less errors than before.