More optimized drawing function
Removed printfs from loop
Stuff was wrong, removed printfs