Added reading registers of motor in protocol handler