Change P,D gains
Update README