Draft: Evan Rushbrook spd cntrl dev

Just did a basic PID control to get access, had a busy week last week so I will be doing more work on it soon.

I think the git push worked, but I am not sure, so let me know if you are able to access what I made.

Thanks