Fixed stomp_write

Wouldn't properly detect the length of a frame body. body_length would be 0 even though there is a body => no message body when message is sent