Lego Update

some extra tests for lego found + bluetooth initialisation