Implemented pd_controller in final_proj_skel.