Arduino Creating A Function In C