Update mqttsn_willmsg.h