Moved blockID constants inside block detection
Block recognition with ratios
Improved block recognition working
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
made program not exit after block grab