Still funky, but works

This is my in-contest modified stuff for the arduino