Merge pull request #1 from Azrrael-exe/StopTest

- Stop test afte the poetry
- Serial Debug

- Added serial debug to the serial to the counter routine
- constants

- Constants fixed
- Debug lines added to check each sensor