Update spindle_control.c

Updated to suit the use of Timer 4 on the MEGA