Add dummy motor code to isr for testing