[BACK]Return to conn.c CVS log [TXT] [DIR] Up to [ELWIX - Embedded LightWeight unIX -] / mqtt / src

Diff for /mqtt/src/Attic/conn.c between versions 1.1.2.9 and 1.1.2.14

version 1.1.2.9, 2011/12/05 17:05:38 version 1.1.2.14, 2011/12/13 15:23:43
Line 8 Line 8
  *   *
  * @buf = Message buffer   * @buf = Message buffer
  * @csConnID = ConnectID   * @csConnID = ConnectID
    * @kasec = Keep alive timeout
  * @csUser = Username if !=NULL   * @csUser = Username if !=NULL
  * @csPass = Password for Username, only if csUser is set   * @csPass = Password for Username, only if csUser is set
  * @csWillTopic = Will Topic if !=NULL Will Flags set into message   * @csWillTopic = Will Topic if !=NULL Will Flags set into message
Line 19 Line 20
  */   */
 int  int
 mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const char *csConnID,   mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const char *csConnID, 
                const char *csUser, const char *csPass,                 u_short kasec, const char *csUser, const char *csPass, 
                 const char *csWillTopic, const char *csWillMessage,                   const char *csWillTopic, const char *csWillMessage, 
                 u_char ClrSess, u_char WillQOS, u_char WillRetain)                  u_char ClrSess, u_char WillQOS, u_char WillRetain)
 {  {
Line 32  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha Line 33  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
   
         if (!buf || !csConnID)          if (!buf || !csConnID)
                 return -1;                  return -1;
        if (strlen(csConnID) > 23) {        if (strlen(csConnID) > 24) {
                 mqtt_SetErr(EINVAL, "Error:: invalid argument ConnID is too long (max 23 bytes)");                  mqtt_SetErr(EINVAL, "Error:: invalid argument ConnID is too long (max 23 bytes)");
                 return -1;                  return -1;
         }          }
        if (csUser && strlen(csUser) > 12) {        if (csUser && strlen(csUser) > 13) {
                 mqtt_SetErr(EINVAL, "Error:: invalid argument Username is too long (max 12 bytes)");                  mqtt_SetErr(EINVAL, "Error:: invalid argument Username is too long (max 12 bytes)");
                 return -1;                  return -1;
         }          }
        if (csPass && strlen(csPass) > 12) {        if (csPass && strlen(csPass) > 13) {
                 mqtt_SetErr(EINVAL, "Error:: invalid argument Password is too long (max 12 bytes)");                  mqtt_SetErr(EINVAL, "Error:: invalid argument Password is too long (max 12 bytes)");
                 return -1;                  return -1;
         }          }
Line 77  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha Line 78  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
   
         /* CONNECT header */          /* CONNECT header */
         flags->clean_sess = ClrSess ? 1 : 0;          flags->clean_sess = ClrSess ? 1 : 0;
        if (csUser) {        if (csUser && *csUser) {
                 flags->username = 1;                  flags->username = 1;
                 flags->password = csPass ? 1 : 0;                  flags->password = csPass ? 1 : 0;
         } else {          } else {
                 flags->username = 0;                  flags->username = 0;
                 flags->password = 0;                  flags->password = 0;
         }          }
        if (csWillTopic) {        if (csWillTopic && *csWillTopic) {
                 flags->will_flg = 1;                  flags->will_flg = 1;
                 flags->will_qos = WillQOS;                  flags->will_qos = WillQOS;
                 flags->will_retain = WillRetain ? 1 : 0;                  flags->will_retain = WillRetain ? 1 : 0;
Line 94  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha Line 95  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
                 flags->will_retain = 0;                  flags->will_retain = 0;
         }          }
   
        ka->sb.l = MQTT_KEEPALIVE;        ka->val = kasec ? htons(kasec) : htons(MQTT_KEEPALIVE);
   
         /* ConnID */          /* ConnID */
         cid = (mqtthdr_var_t*) (buf->msg_base + siz);          cid = (mqtthdr_var_t*) (buf->msg_base + siz);
Line 103  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha Line 104  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
         memcpy(cid->var_data, csConnID, ntohs(cid->var_sb.val));          memcpy(cid->var_data, csConnID, ntohs(cid->var_sb.val));
   
         /* If Will Flags setup */          /* If Will Flags setup */
        if (csWillTopic) {        if (csWillTopic && *csWillTopic) {
                 topic = (mqtthdr_var_t*) (buf->msg_base + siz);                  topic = (mqtthdr_var_t*) (buf->msg_base + siz);
                 topic->var_sb.val = htons(strlen(csWillTopic));                  topic->var_sb.val = htons(strlen(csWillTopic));
                 memcpy(topic->var_data, csWillTopic, ntohs(topic->var_sb.val));                  memcpy(topic->var_data, csWillTopic, ntohs(topic->var_sb.val));
                 siz += MQTTHDR_VAR_SIZEOF(topic);                  siz += MQTTHDR_VAR_SIZEOF(topic);
   
                 wmsg = (mqtthdr_var_t*) (buf->msg_base + siz);                  wmsg = (mqtthdr_var_t*) (buf->msg_base + siz);
                if (csWillMessage) {                if (csWillMessage && *csWillMessage) {
                         wmsg->var_sb.val = htons(strlen(csWillMessage));                          wmsg->var_sb.val = htons(strlen(csWillMessage));
                         memcpy(wmsg->var_data, csWillMessage, ntohs(wmsg->var_sb.val));                          memcpy(wmsg->var_data, csWillMessage, ntohs(wmsg->var_sb.val));
                 } else                  } else
Line 119  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha Line 120  mqtt_msgCONNECT(mqtt_msg_t * __restrict buf, const cha
         }          }
   
         /* If defined Username & Password */          /* If defined Username & Password */
        if (csUser) {        if (csUser && *csUser) {
                 user = (mqtthdr_var_t*) (buf->msg_base + siz);                  user = (mqtthdr_var_t*) (buf->msg_base + siz);
                 user->var_sb.val = htons(strlen(csUser));                  user->var_sb.val = htons(strlen(csUser));
                 memcpy(user->var_data, csUser, ntohs(user->var_sb.val));                  memcpy(user->var_data, csUser, ntohs(user->var_sb.val));
                 siz += MQTTHDR_VAR_SIZEOF(user);                  siz += MQTTHDR_VAR_SIZEOF(user);
   
                if (csPass) {                if (csPass && *csPass) {
                         pass = (mqtthdr_var_t*) (buf->msg_base + siz);                          pass = (mqtthdr_var_t*) (buf->msg_base + siz);
                         pass->var_sb.val = htons(strlen(csPass));                          pass->var_sb.val = htons(strlen(csPass));
                         memcpy(pass->var_data, csPass, ntohs(pass->var_sb.val));                          memcpy(pass->var_data, csPass, ntohs(pass->var_sb.val));
Line 253  mqtt_msgDISCONNECT(mqtt_msg_t * __restrict buf) Line 254  mqtt_msgDISCONNECT(mqtt_msg_t * __restrict buf)
  * @userLen = Username length   * @userLen = Username length
  * @psPass = Password for Username, only if csUser is set   * @psPass = Password for Username, only if csUser is set
  * @passLen = Password length   * @passLen = Password length
 * @psWillTopic = Will Topic if !=NULL Will Flags set into message * @psWillTopic = Will Topic if !=NULL Will Flags set into message and must be free()
 * @topicLen = Will Topic length * @psWillMessage = Will Message, may be NULL if !NULL must be free() after use!
 * @psWillMessage = Will Message, may be NULL 
 * @msgLen = Will Message length 
  * return: .reserved == 1 is error or == 0 connection flags & msg ok   * return: .reserved == 1 is error or == 0 connection flags & msg ok
  */   */
mqtthdr_connflgs_tmqtthdr_connack_t
 mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short *kasec, char * __restrict psConnID, int connLen,   mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short *kasec, char * __restrict psConnID, int connLen, 
                 char * __restrict psUser, int userLen, char * __restrict psPass, int passLen,                    char * __restrict psUser, int userLen, char * __restrict psPass, int passLen,  
                char * __restrict psWillTopic, int topicLen, char * __restrict psWillMessage, int msgLen)                char ** __restrict psWillTopic, char ** __restrict psWillMessage)
 {  {
        mqtthdr_connflgs_t flg = MQTT_CONNFLGS_INIT;        mqtthdr_connflgs_t flg = { MQTT_CONNFLGS_INIT };
         mqtthdr_connack_t cack = { 1, MQTT_RETCODE_DENIED };
         struct mqtthdr *hdr;          struct mqtthdr *hdr;
         mqtthdr_var_t *var;          mqtthdr_var_t *var;
         mqtt_v_t *ka;          mqtt_v_t *ka;
Line 273  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 273  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
         caddr_t pos;          caddr_t pos;
   
         if (!buf || !buf->msg_base || !buf->msg_len || !psConnID || !connLen)          if (!buf || !buf->msg_base || !buf->msg_len || !psConnID || !connLen)
                return flg;                return cack;
   
         hdr = _mqtt_readHEADER(buf, MQTT_TYPE_CONNECT, &ret, &len);          hdr = _mqtt_readHEADER(buf, MQTT_TYPE_CONNECT, &ret, &len);
         if (!hdr)          if (!hdr)
                return flg;                return cack;
         if (len < 12) {          if (len < 12) {
                 mqtt_SetErr(EINVAL, "Error:: short message length %d", len);                  mqtt_SetErr(EINVAL, "Error:: short message length %d", len);
                return flg;                return cack;
         } else {          } else {
                 pos = buf->msg_base + ret + 1;                  pos = buf->msg_base + ret + 1;
                 var = (mqtthdr_var_t*) pos;                  var = (mqtthdr_var_t*) pos;
         }          }
         /* check init string & protocol */          /* check init string & protocol */
        if (var->var_sb.sb.l != 6 || strncmp(var->var_data, MQTT_CONN_STR, 6)) {        if (var->var_sb.sb.l != 6 || strncmp((char*) var->var_data, MQTT_CONN_STR, 6)) {
                 mqtt_SetErr(EINVAL, "Error:: invalid init string %.6s(%d)",                   mqtt_SetErr(EINVAL, "Error:: invalid init string %.6s(%d)", 
                                 var->var_data, var->var_sb.sb.l);                                  var->var_data, var->var_sb.sb.l);
                return flg;                cack.retcode = MQTT_RETCODE_REFUSE_UNAVAIL;
                 return cack;
         } else {          } else {
                 pos += var->var_sb.sb.l + sizeof(mqtt_v_t);                  pos += var->var_sb.sb.l + sizeof(mqtt_v_t);
                 proto = (mqtthdr_protover_t*) pos;                  proto = (mqtthdr_protover_t*) pos;
         }          }
         if (*proto != MQTT_PROTO_VER) {          if (*proto != MQTT_PROTO_VER) {
                 mqtt_SetErr(EINVAL, "Error:: invalid protocol version %d", *pos);                  mqtt_SetErr(EINVAL, "Error:: invalid protocol version %d", *pos);
                return flg;                cack.retcode = MQTT_RETCODE_REFUSE_VER;
                 return cack;
         } else          } else
                 pos++;                  pos++;
         flg = *(mqtthdr_connflgs_t*) pos;          flg = *(mqtthdr_connflgs_t*) pos;
Line 312  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 314  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
         len -= MQTTHDR_VAR_SIZEOF(var);          len -= MQTTHDR_VAR_SIZEOF(var);
         if (len < 0) {          if (len < 0) {
                 mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Connection ID %d", len);                  mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Connection ID %d", len);
                flg.reserved = 1;                cack.retcode = MQTT_RETCODE_REFUSE_ID;
                return flg;                return cack;
         } else {          } else {
                 memset(psConnID, 0, connLen--);                  memset(psConnID, 0, connLen--);
                 memcpy(psConnID, var->var_data, ntohs(var->var_sb.val) > connLen ? connLen : ntohs(var->var_sb.val));                  memcpy(psConnID, var->var_data, ntohs(var->var_sb.val) > connLen ? connLen : ntohs(var->var_sb.val));
Line 326  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 328  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
                 len -= MQTTHDR_VAR_SIZEOF(var);                  len -= MQTTHDR_VAR_SIZEOF(var);
                 if (len < 0) {                  if (len < 0) {
                         mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Will Topic %d", len);                          mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Will Topic %d", len);
                        flg.reserved = 1;                        cack.retcode = MQTT_RETCODE_REFUSE_ID;
                        return flg;                        return cack;
                 } else {                  } else {
                        if (psWillTopic && topicLen) {                        if (psWillTopic) {
                                memset(psWillTopic, 0, topicLen--);                                *psWillTopic = malloc(ntohs(var->var_sb.val) + 1);
                                memcpy(psWillTopic, var->var_data,                                 if (!*psWillTopic) {
                                                ntohs(var->var_sb.val) > topicLen ? topicLen : ntohs(var->var_sb.val));                                        LOGERR;
                                         cack.retcode = MQTT_RETCODE_REFUSE_UNAVAIL;
                                         return cack;
                                 } else
                                         memset(*psWillTopic, 0, ntohs(var->var_sb.val) + 1);
                                 memcpy(*psWillTopic, var->var_data, ntohs(var->var_sb.val));
                         }                          }
                         pos += MQTTHDR_VAR_SIZEOF(var);                          pos += MQTTHDR_VAR_SIZEOF(var);
                 }                  }
Line 341  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 348  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
                 len -= MQTTHDR_VAR_SIZEOF(var);                  len -= MQTTHDR_VAR_SIZEOF(var);
                 if (len < 0) {                  if (len < 0) {
                         mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Will Message %d", len);                          mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Will Message %d", len);
                        flg.reserved = 1;                        cack.retcode = MQTT_RETCODE_REFUSE_ID;
                        return flg;                        return cack;
                 } else {                  } else {
                        if (psWillMessage && msgLen) {                        if (psWillMessage) {
                                memset(psWillMessage, 0, msgLen--);                                *psWillMessage = malloc(ntohs(var->var_sb.val) + 1);
                                memcpy(psWillMessage, var->var_data,                                 if (!*psWillMessage) {
                                                ntohs(var->var_sb.val) > msgLen ? msgLen : ntohs(var->var_sb.val));                                        LOGERR;
                                         cack.retcode = MQTT_RETCODE_REFUSE_UNAVAIL;
                                         return cack;
                                 } else
                                         memset(*psWillMessage, 0, ntohs(var->var_sb.val) + 1);
                                 memcpy(*psWillMessage, var->var_data, ntohs(var->var_sb.val));
                         }                          }
                         pos += MQTTHDR_VAR_SIZEOF(var);                          pos += MQTTHDR_VAR_SIZEOF(var);
                 }                  }
Line 359  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 371  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
                 len -= MQTTHDR_VAR_SIZEOF(var);                  len -= MQTTHDR_VAR_SIZEOF(var);
                 if (len < 0) {                  if (len < 0) {
                         mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Username %d", len);                          mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Username %d", len);
                        flg.reserved = 1;                        cack.retcode = MQTT_RETCODE_REFUSE_USERPASS;
                        return flg;                        return cack;
                 } else {                  } else {
                         if (psUser && userLen) {                          if (psUser && userLen) {
                                 memset(psUser, 0, userLen--);                                  memset(psUser, 0, userLen--);
Line 375  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 387  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
                 len -= MQTTHDR_VAR_SIZEOF(var);                  len -= MQTTHDR_VAR_SIZEOF(var);
                 if (len < 0) {                  if (len < 0) {
                         mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Password %d", len);                          mqtt_SetErr(EINVAL, "Error:: unexpected EOM at Password %d", len);
                        flg.reserved = 1;                        cack.retcode = MQTT_RETCODE_REFUSE_USERPASS;
                        return flg;                        return cack;
                 } else {                  } else {
                         if (psPass && passLen) {                          if (psPass && passLen) {
                                 memset(psPass, 0, passLen--);                                  memset(psPass, 0, passLen--);
Line 387  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short  Line 399  mqtt_readCONNECT(mqtt_msg_t * __restrict buf, u_short 
                 }                  }
         }          }
   
        return flg;        flg.reserved = 0;
         cack.reserved = flg.flags;
         cack.retcode = MQTT_RETCODE_ACCEPTED;
         return cack;
 }  }
   
 /*  /*
Removed from v.1.1.2.9  
changed lines
  Added in v.1.1.2.14

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>