Minor changes, faster PWM for heater possible.
Added M99 command (deselect motor for S seconds), fixed M340 bug.