MCU crashing was a major issue. Sorted that out by putting a bunch of capacitors across the motor. This was used as a reference - http://www.beam-wiki.org/wiki/Reducing_Motor_Noise