Glassfrog 8.5

Finished new autonomous, requires reveiwing and testing.