Bresenham algorithm for the first octant
Complete Bresenham Algorithm
Fix E command and add G92 g-code command