Added Motor testing code that actually working