Revert "Tuned PD Wall follower and fixed sign issue in PD Controller"

This reverts commit b623b3efe407aaac0aba8780e4cdecfcf50b0b4a.