Block Recognition working
no false positives!
added some comments
Bluetooth commands work!

Localization is a bit off though, not sure why
Basic Functionality for the demo complete