version 1.1.1.1.2.3, 2012/04/07 20:48:39
|
version 1.1.1.1.2.11, 2012/04/27 16:17:11
|
Line 53 char mqtt_Error[STRSIZ];
|
Line 53 char mqtt_Error[STRSIZ];
|
|
|
#pragma GCC visibility pop |
#pragma GCC visibility pop |
|
|
// |
|
// Error maintenance functions ... |
|
// |
|
|
|
// mqtt_GetErrno() Get error code of last operation |
// mqtt_GetErrno() Get error code of last operation |
inline int |
inline int |
mqtt_GetErrno() |
mqtt_GetErrno() |
Line 85 mqtt_SetErr(int eno, char *estr, ...)
|
Line 81 mqtt_SetErr(int eno, char *estr, ...)
|
} |
} |
|
|
#pragma GCC visibility push(hidden) |
#pragma GCC visibility push(hidden) |
// _mqtt_readHEADER() read fixed header from MQTT message | /* _mqtt_readHEADER() read fixed header from MQTT message */ |
inline struct mqtthdr * |
inline struct mqtthdr * |
_mqtt_readHEADER(mqtt_msg_t * __restrict buf, u_char cmd, int *bytes, int *len) |
_mqtt_readHEADER(mqtt_msg_t * __restrict buf, u_char cmd, int *bytes, int *len) |
{ |
{ |
Line 106 _mqtt_readHEADER(mqtt_msg_t * __restrict buf, u_char c
|
Line 102 _mqtt_readHEADER(mqtt_msg_t * __restrict buf, u_char c
|
} |
} |
#pragma GCC visibility pop |
#pragma GCC visibility pop |
|
|
// ---------------------------------------------------------- |
|
|
|
/* |
/* |
* mqtt_msgFree() Free MQTT message |
* mqtt_msgFree() Free MQTT message |
Line 179 mqtt_msgRealloc(mqtt_msg_t * __restrict msg, u_short l
|
Line 174 mqtt_msgRealloc(mqtt_msg_t * __restrict msg, u_short l
|
if (!msg) |
if (!msg) |
return -1; |
return -1; |
|
|
if (len == msg->msg_len) | if (len <= msg->msg_len) |
return len; |
return len; |
|
|
p = realloc(msg->msg_base, len); |
p = realloc(msg->msg_base, len); |
Line 275 mqtt_sizeLen(u_int len)
|
Line 270 mqtt_sizeLen(u_int len)
|
} |
} |
|
|
/* |
/* |
* mqtt_str2sub Create MQTT subscribe variable from string(s) | * mqtt_str2subs Create MQTT subscribe variable from string(s) |
* |
* |
* @csStr = strings | * @csStr = null terminated string array |
* @strnum = number of strings elements | * @strnum = copy at most number of strings elements |
* @qoses = QoS elements applied to subscribe variable, |
* @qoses = QoS elements applied to subscribe variable, |
* count of elements must be equal with csStr elements |
* count of elements must be equal with csStr elements |
* return: NULL error or != subscribe variables array, must be free after use with mqtt_freeSub() |
* return: NULL error or != subscribe variables array, must be free after use with mqtt_freeSub() |
*/ |
*/ |
inline mqtt_subscr_t * |
inline mqtt_subscr_t * |
mqtt_str2sub(const char **csStr, u_short strnum, u_char *qoses) | mqtt_str2subs(const char **csStr, u_short strnum, u_char *qoses) |
{ |
{ |
mqtt_subscr_t *v; |
mqtt_subscr_t *v; |
register int i, items; |
register int i, items; |
Line 292 mqtt_str2sub(const char **csStr, u_short strnum, u_cha
|
Line 287 mqtt_str2sub(const char **csStr, u_short strnum, u_cha
|
|
|
if (!csStr) |
if (!csStr) |
return NULL; |
return NULL; |
for (items = 0, strs = csStr; *strs; items++, strs++) |
|
if (strnum && items >= strnum) { |
|
items = strnum; |
|
break; |
|
} |
|
|
|
|
for (items = 0, strs = csStr; |
|
(!strnum || (strnum && items < strnum)) && *strs; |
|
items++, strs++); |
|
|
if (!(v = malloc((items + 1) * sizeof(mqtt_subscr_t)))) { |
if (!(v = malloc((items + 1) * sizeof(mqtt_subscr_t)))) { |
LOGERR; |
LOGERR; |
return NULL; |
return NULL; |
Line 373 mqtt_subAlloc(u_short num)
|
Line 367 mqtt_subAlloc(u_short num)
|
* return: NULL error or subscribe array, after use must call mqtt_subFree() |
* return: NULL error or subscribe array, after use must call mqtt_subFree() |
*/ |
*/ |
inline mqtt_subscr_t * |
inline mqtt_subscr_t * |
mqtt_subRealloc(mqtt_subscr_t * __restrict subs, u_short num) | mqtt_subRealloc(mqtt_subscr_t ** __restrict subs, u_short num) |
{ |
{ |
mqtt_subscr_t *s = NULL; |
mqtt_subscr_t *s = NULL; |
|
|
s = realloc(subs, (num + 1) * sizeof(mqtt_subscr_t)); | if (!subs) |
| return NULL; |
| |
| s = realloc(*subs, (num + 1) * sizeof(mqtt_subscr_t)); |
if (!s) { |
if (!s) { |
LOGERR; |
LOGERR; |
return NULL; |
return NULL; |
|
} else { |
|
memset(s + num, 0, sizeof(mqtt_subscr_t)); |
|
*subs = s; |
} |
} |
|
|
return s; | return *subs; |
} |
} |
|
|
/* |
/* |
|
* mqtt_subCopy() - Copy subscription structure to another one |
|
* |
|
* @dst = destination subscription |
|
* @src = source subscription |
|
* return: =NULL error or !=NULL successful copied a structure |
|
*/ |
|
inline mqtt_subscr_t * |
|
mqtt_subCopy(mqtt_subscr_t * __restrict dst, mqtt_subscr_t * __restrict src) |
|
{ |
|
if (!dst || !src) |
|
return NULL; |
|
|
|
if (src->sub_topic.msg_base) { |
|
dst->sub_topic.msg_base = malloc(src->sub_topic.msg_len + 1); |
|
if (!dst->sub_topic.msg_base) { |
|
LOGERR; |
|
memset(dst, 0, sizeof(mqtt_subscr_t)); |
|
return NULL; |
|
} else { |
|
dst->sub_topic.msg_len = src->sub_topic.msg_len; |
|
((char*) dst->sub_topic.msg_base)[dst->sub_topic.msg_len] = 0; |
|
memcpy(dst->sub_topic.msg_base, src->sub_topic.msg_base, |
|
dst->sub_topic.msg_len); |
|
} |
|
} |
|
if (src->sub_value.msg_base) { |
|
dst->sub_value.msg_base = malloc(src->sub_value.msg_len + 1); |
|
if (!dst->sub_value.msg_base) { |
|
LOGERR; |
|
if (dst->sub_topic.msg_base) |
|
free(dst->sub_topic.msg_base); |
|
memset(dst, 0, sizeof(mqtt_subscr_t)); |
|
return NULL; |
|
} else { |
|
dst->sub_value.msg_len = src->sub_value.msg_len; |
|
((char*) dst->sub_value.msg_base)[dst->sub_value.msg_len] = 0; |
|
memcpy(dst->sub_value.msg_base, src->sub_value.msg_base, |
|
dst->sub_value.msg_len); |
|
} |
|
} |
|
|
|
dst->sub_ret = src->sub_ret; |
|
return dst; |
|
} |
|
|
|
|
|
/* |
* mqtt_expandTopic() - Expanding topic to regular expression |
* mqtt_expandTopic() - Expanding topic to regular expression |
* |
* |
* @csInput = Input topic |
* @csInput = Input topic |
Line 543 mqtt_sqlTopic(const char *csInput, char * __restrict p
|
Line 590 mqtt_sqlTopic(const char *csInput, char * __restrict p
|
*s = *pos; |
*s = *pos; |
} |
} |
|
|
|
return ret; |
|
} |
|
|
|
|
|
/* |
|
* mqtt_KeepAlive() - Keep Alive check routine |
|
* |
|
* @sock = connected socket |
|
* @ka = keep alive timeout |
|
* @tries = tries for receive correct ping response, usually ==1 |
|
* return: -1 error, 0 host is alive, 1 timeout session or 2 broken session |
|
*/ |
|
int |
|
mqtt_KeepAlive(int sock, u_short ka, u_char tries) |
|
{ |
|
int ret = 0; |
|
struct pollfd pfd; |
|
mqtt_msg_t msg = { NULL, 0 }; |
|
|
|
if (sock < 3) |
|
return -1; /* error */ |
|
|
|
pfd.fd = sock; |
|
pfd.events = POLLOUT; |
|
if ((ret = poll(&pfd, 1, ka * 1000)) == -1 || |
|
pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { |
|
LOGERR; |
|
return -1; /* error */ |
|
} else if (!ret) |
|
return 1; /* session is abandoned ... must be disconnect! */ |
|
/* ping request */ |
|
if ((ret = mqtt_msgPINGREQ(&msg)) == -1) |
|
return -1; /* error */ |
|
if ((ret = send(sock, msg.msg_base, ret, MSG_NOSIGNAL)) == -1) { |
|
LOGERR; |
|
goto end; |
|
} |
|
|
|
pfd.events = POLLIN | POLLPRI; |
|
while (tries--) { |
|
if ((ret = poll(&pfd, 1, ka * 1000)) == -1 || |
|
pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { |
|
LOGERR; |
|
break; |
|
} else if (!ret) { |
|
ret = 1; /* session is abandoned ... must be disconnect! */ |
|
continue; |
|
} |
|
/* receive & decode packet */ |
|
if ((ret = recv(sock, msg.msg_base, msg.msg_len, 0)) == -1) { |
|
LOGERR; |
|
break; |
|
} |
|
if (!mqtt_readPINGRESP(&msg)) { |
|
ret = 0; /* Host is alive */ |
|
break; |
|
} else |
|
ret = 2; /* Session is broken ... must be disconnect! */ |
|
} |
|
end: |
|
free(msg.msg_base); |
return ret; |
return ret; |
} |
} |