Fix M503 output
Merge pull request #24 from zarya/master

Fix M503 output