Arduino Create Function With C