Create header for diff_drive_controller.cpp

This keeps the same functionality, but cleans up the code.