Copied old code to keep old autonomous

Copied old code to keep old autonomous