Fix missing strlen_P check in msgqueue add