Modified Phase B Smart Code

- Added some comments
- Added Encoder header and objects
- Added PID header