Fix output of M665 and M666 to be pronterface friendly