Updated controller so now has two PIDs and might even work.