Return to srvside.c CVS log

Up to [ELWIX - Embedded LightWeight unIX -] / libaitmqtt / src

version 1.1

    1: /*************************************************************************
    2: * (C) 2011 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com>
    3: *  by Michael Pounov <misho@openbsd-bg.org>
    4: *
    5: * $Author: misho $
    6: * $Id: srvside.c,v 1.2 2012/06/20 15:02:24 misho Exp $
    7: *
    8: **************************************************************************
    9: The ELWIX and AITNET software is distributed under the following
   10: terms:
   11: 
   12: All of the documentation and software included in the ELWIX and AITNET
   13: Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
   14: 
   15: Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012
   16: 	by Michael Pounov <misho@elwix.org>.  All rights reserved.
   17: 
   18: Redistribution and use in source and binary forms, with or without
   19: modification, are permitted provided that the following conditions
   20: are met:
   21: 1. Redistributions of source code must retain the above copyright
   22:    notice, this list of conditions and the following disclaimer.
   23: 2. Redistributions in binary form must reproduce the above copyright
   24:    notice, this list of conditions and the following disclaimer in the
   25:    documentation and/or other materials provided with the distribution.
   26: 3. All advertising materials mentioning features or use of this software
   27:    must display the following acknowledgement:
   28: This product includes software developed by Michael Pounov <misho@elwix.org>
   29: ELWIX - Embedded LightWeight unIX and its contributors.
   30: 4. Neither the name of AITNET nor the names of its contributors
   31:    may be used to endorse or promote products derived from this software
   32:    without specific prior written permission.
   33: 
   34: THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
   35: ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   36: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   37: ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
   38: FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   39: DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   40: OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   41: HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   42: LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   43: OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   44: SUCH DAMAGE.
   45: */
   46: #include "global.h"
   47: 
   48: 
   49: /*
   50:  * mqtt_srv_Init() Init MQTT server side support
   51:  *
   52:  * @sock = Client socket from accept()
   53:  * @buf = Message buffer
   54:  * @timeout = timeout
   55:  * return: NULL error or !=NULL allocated server handle
   56:  */
   57: mqtt_srv_t *
   58: mqtt_srv_Init(int sock, mqtt_msg_t * __restrict buf, u_short timeout)
   59: {
   60: 	mqtt_srv_t *srv = NULL;
   61: 
   62: 	if (!buf || !buf->msg_base || !buf->msg_len)
   63: 		return srv;
   64: 
   65: 	srv = malloc(sizeof(mqtt_srv_t));
   66: 	if (!srv) {
   67: 		LOGERR;
   68: 		return srv;
   69: 	} else
   70: 		memset(srv, 0, sizeof(mqtt_srv_t));
   71: 
   72: 	srv->sock = sock;
   73: 	srv->buf = buf;
   74: 	srv->timeout = timeout;
   75: 
   76: 	return srv;
   77: }
   78: 
   79: /*
   80:  * mqtt_srv_Fini() Finish MQTT server side support
   81:  *
   82:  * @psrv = Server handle
   83:  * return: none
   84:  */
   85: void
   86: mqtt_srv_Fini(mqtt_srv_t ** __restrict psrv)
   87: {
   88: 	if (psrv && *psrv) {
   89: 		free(*psrv);
   90: 		*psrv = NULL;
   91: 	}
   92: }
   93: 
   94: /*
   95:  * mqtt_srv_Dispatch() MQTT server dispatcher
   96:  *
   97:  * @srv = Server handle
   98:  * @rlen = Ready bytes to parse
   99:  * @arg = Argument pass to command callback
  100:  * return: -1 error or 0 ok
  101:  */
  102: int
  103: mqtt_srv_Dispatch(mqtt_srv_t * __restrict srv, int rlen, void *arg)
  104: {
  105: 	struct mqtthdr *hdr;
  106: 
  107: 	if (!srv || !srv->buf->msg_base || !srv->buf->msg_len)
  108: 		return -1;
  109: 	if (srv->buf->msg_len < sizeof(struct mqtthdr) || rlen < sizeof(struct mqtthdr)) {
  110: 		mqtt_SetErr(EINVAL, "Message is too short ...");
  111: 		return -1;
  112: 	}
  113: 	hdr = (struct mqtthdr*) srv->buf->msg_base;
  114: 	if (hdr->mqtt_msg.type > MQTT_TYPE_MAX) {
  115: 		mqtt_SetErr(ENOSYS, "Message type %d not implemented", hdr->mqtt_msg.type);
  116: 		return -1;
  117: 	}
  118: 	if (srv->cmds[hdr->mqtt_msg.type])
  119: 		return srv->cmds[hdr->mqtt_msg.type]((void*) srv, rlen, arg);
  120: 
  121: 	mqtt_SetErr(ENOTSUP, "Unsupported message type %d", hdr->mqtt_msg.type);
  122: 	return -1;
  123: }