Arduino Create Own Function