Modified for two counter interupt + 2 motor output