Added a few more improvements from RRP's dev branch Corrected M201 output Added a few more minor fixes