Added in arc turn method and moved test code out of main into their own functions.