Motor Control Working :) (NOT! Test only)

(Theoretical Example - NOT REAL!)
motor_controller.c now implements void pid() to use sensor readings to
maintain constant direction