cleaned up codegen a bit
Upload to arduino finally working