Optimize by removing branches

[SPauly]

The code currently uses a lot of switch and if-elses. When optimizing I might want to take a look at the disassembly and see where I can remove branches.