Fix output of M665 and M666 to be pronterface friendly
Merge pull request #246 from wolfmanjm/upstreamedge

Fix output of M665 and M666 to be pronterface friendly