addes data packetization, set LED, torque, brake