Added wiring diagram

- Added wiring diagram
- Fixer a small bug in the firmware