cmd/lms/ProtocolCompat.cpp

617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan/*******************************************************************************
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * Copyright (C) 2004-2008 Intel Corp. All rights reserved.
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * Redistribution and use in source and binary forms, with or without
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * modification, are permitted provided that the following conditions are met:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *  - Redistributions of source code must retain the above copyright notice,
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *    this list of conditions and the following disclaimer.
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *  - Redistributions in binary form must reproduce the above copyright notice,
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *    this list of conditions and the following disclaimer in the documentation
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *    and/or other materials provided with the distribution.
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *  - Neither the name of Intel Corp. nor the names of its
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *    contributors may be used to endorse or promote products derived from this
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *    software without specific prior written permission.
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS ``AS IS''
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * ARE DISCLAIMED. IN NO EVENT SHALL Intel Corp. OR THE CONTRIBUTORS
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan * POSSIBILITY OF SUCH DAMAGE.
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan *******************************************************************************/
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#ifdef HAVE_CONFIG_H
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include "config.h"
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#endif
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#if defined(__sun) || defined(_LINUX)
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include <arpa/inet.h>
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include <netinet/in.h>
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#else
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include <winsock2.h>
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#endif  // __sun || _LINUX
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include <cerrno>
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include "Protocol.h"
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include "LMS_if_compat.h"
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include "Lock.h"
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan#include "ATNetworkTool.h"
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Loganvoid Protocol::_LmeReceiveCompat(char *buffer, unsigned int len, int *status)
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan{
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    int error = 0;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    PRINT("[Compat]HECI receive %d bytes (msg type 0x%02x)\n", len, buffer[0]);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    *status = 0;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    switch (buffer[0]) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    case LMS_MESSAGE_TYPE_OPEN_CONNECTION_EX:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            SOCKET s_new = INVALID_SOCKET;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            LMS_OPEN_CONNECTION_EX_MESSAGE *msg =
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                (LMS_OPEN_CONNECTION_EX_MESSAGE *)buffer;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            int type;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            switch (msg->Protocol) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            case LMS_PROTOCOL_TYPE_UDP_IPV4:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                type = SOCK_DGRAM;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            case LMS_PROTOCOL_TYPE_TCP_IPV4:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            default:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                type = SOCK_STREAM;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            if ((msg->Flags & HOSTNAME_BIT) != 0) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                PRINT("[Compat]Got client connection request %d for host %s, port %d\n",
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    msg->ConnectionId,
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    msg->Host,
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    ntohs(msg->HostPort));
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                s_new = ATNetworkTool::Connect(
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    (const char *)msg->Host,
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    ntohs(msg->HostPort),
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    error, PF_INET, type);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            } else {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                PRINT("[Compat]Got client connection request %d for IP %s, port %d\n",
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    msg->ConnectionId,
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    inet_ntoa(*((struct in_addr *)msg->Host)),
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    ntohs(msg->HostPort));
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                s_new = ATNetworkTool::Connect(
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    inet_ntoa(*((struct in_addr *)msg->Host)),
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    ntohs(msg->HostPort),
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    error, PF_INET, type);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            if (s_new == INVALID_SOCKET) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                *status = 1;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            Channel *c = new Channel(NULL, s_new);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            c->SetRecipientChannel(msg->ConnectionId);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            c->SetStatus(Channel::OPEN);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            c->AddBytesTxWindow(1024);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                Lock l(_channelsLock);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                _openChannels[msg->ConnectionId] = c;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            _signalSelect();
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    case LMS_MESSAGE_TYPE_CLOSE_CONNECTION:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            LMS_CLOSE_CONNECTION_MESSAGE *msg =
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                (LMS_CLOSE_CONNECTION_MESSAGE *)buffer;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            PRINT("[Compat]received close connection msg from HECI for connection %d\n", msg->ConnectionId);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            Lock l(_channelsLock);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            ChannelMap::iterator it = _openChannels.find(msg->ConnectionId);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            if (it != _openChannels.end()) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                _closeMChannel(it->second);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                _openChannels.erase(it);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    case LMS_MESSAGE_TYPE_SEND_DATA:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            LMS_SEND_DATA_MESSAGE *msg =
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                (LMS_SEND_DATA_MESSAGE *)buffer;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            Lock l(_channelsLock);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            ChannelMap::iterator it = _openChannels.find(msg->ConnectionId);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            if (it != _openChannels.end()) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                PRINT("[Compat]sending %d bytes from HECI connection %d to socket %d\n", ntohs(msg->DataLength), msg->ConnectionId, it->second->GetSocket());
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                if (-1 == _send(it->second->GetSocket(), (char *)msg->Data, ntohs(msg->DataLength), error)) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    if (EPIPE == error) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                        _closeMChannel(it->second);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                        _openChannels.erase(it);
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                        *status = 1;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                    }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan                }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    case LMS_MESSAGE_TYPE_IP_FQDN:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        if (_updateIPFQDN((const char *)((LMS_IP_FQDN_MESSAGE *)buffer)->FQDN) != 0) {
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan            ERROR("[Compat]Error: failed to update IP/FQDN info\n");
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    default:
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        *status = 1;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan        break;
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan    }
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan}
617e2443dfc17fe44fd44c0675d6aad2ffc9df42Mark Logan