Fixed error with motors in protocol handler
Fixed error with motors in protocol handler and deleted unused bit
Changes in test files and some changes in sensor API