fixed PD method

big problem in it with how I was scaling/normalizing