fix bug in M200 with multiple extruders

Bug that prevented M200 with T code from functioning.