Added unit tests and small modiciations to the interface
Refactored code and added auto tool setup in G-Code