PDLineFollowerClass

Start of PD control integration