Added Robot Class wtih Double PID Loop, no testing yet, but it compiles