Motor controller code for attiny 84