Fixes

Fixed an issue with some of the arm restrictions; fixed some functions
in autonomus and wrote a program.