Add init() function
Send init message over RS232