Fixed some issues in bitwise stuff in sensors lib
Added debugging lib