fix bug in M200 with multiple extruders
Merge pull request #864 from whosawhatsis/M200

fix bug in M200 with multiple extruders