P loop

Now turns properly (sorta) with a P loop. Working on the PD right now.