NXTcontrol: Rewrite of Bluetooth communication; Added sensor reading function