Switch and counter optimization 

Switch might, in a blue moon, help with the speed of writing characters.
I am not sure if the counter "i" will help, the memory wont need to be dimension again.
Merge pull request #3 from gravypod/patch-2

Well I will say that in C the switch looks very pretty compared to the if else chain. However, the actual compiled assembler isn't any more efficient as far as I can see. This is being compiled with the make file provided.