changed the BT communication like in the Lego NXT branch (not tested yet)