code.vuplus.com Git - vuplus_dvbapp/blob - lib/mmi/socket_mmi.cpp

   1 #include <lib/mmi/socket_mmi.h>
   2
   3 #include <unistd.h>
   4 #include <fcntl.h>
   5 #include <sys/ioctl.h>
   6
   7 #include <lib/base/ebase.h>
   8 #include <lib/base/init.h>
   9 #include <lib/base/init_num.h>
  10 #include <lib/base/eerror.h>
  11 #include <lib/base/estring.h>
  12 #include <lib/dvb_ci/dvbci_session.h>
  13
  14 #define MAX_LENGTH_BYTES 4
  15 #define MIN_LENGTH_BYTES 1
  16 #define MMIDEBUG
  17
  18 eSocket_UI *eSocket_UI::instance;
  19
  20 eSocket_UI::eSocket_UI()
  21         :eMMI_UI(1)
  22 {
  23         ASSERT(!instance);
  24         instance = this;
  25         CONNECT(handler.mmi_progress, eMMI_UI::processMMIData);
  26 }
  27
  28 eSocket_UI *eSocket_UI::getInstance()
  29 {
  30         return instance;
  31 }
  32
  33 void eSocket_UI::setInit(int slot)
  34 {
  35         //NYI
  36 }
  37
  38 void eSocket_UI::setReset(int slot)
  39 {
  40         //NYI
  41 }
  42
  43 int eSocket_UI::startMMI(int slot)
  44 {
  45         unsigned char buf[]={0x9F,0x80,0x22,0x00};  // ENTER MMI
  46         if (handler.send_to_mmisock( buf, 4 ))
  47         {
  48                 eDebug("eSocket_UI::startMMI failed");
  49                 return -1;
  50         }
  51         return 0;
  52 }
  53
  54 int eSocket_UI::stopMMI(int slot)
  55 {
  56         unsigned char buf[]={0x9F,0x88,0x00,0x00};  // CLOSE MMI
  57         if (handler.send_to_mmisock( buf, 4 ))
  58         {
  59                 eDebug("eSocket_UI::stopMMI failed");
  60                 return -1;
  61         }
  62         return 0;
  63 }
  64
  65 int eSocket_UI::answerMenu(int slot, int answer)
  66 {
  67         unsigned char data[]={0x9f,0x88,0x0B,0x01,0x00};
  68         data[4] = answer & 0xff;
  69         if (handler.send_to_mmisock( data, 5 ))
  70         {
  71                 eDebug("eSocket_UI::answerMenu failed");
  72                 return -1;
  73         }
  74         return 0;
  75 }
  76
  77 int eSocket_UI::answerEnq(int slot, char *answer)
  78 {
  79         unsigned int len = strlen(answer);
  80         unsigned char data[4+len+MAX_LENGTH_BYTES];
  81         data[0] = 0x9f;
  82         data[1] = 0x88;
  83         data[2] = 0x08;
  84         int LengthBytes=eDVBCISession::buildLengthField(data+3, len+1);
  85         data[3+LengthBytes] = 0x01;
  86         memcpy(data+4+LengthBytes, answer, len);
  87         if (handler.send_to_mmisock( data, len+4+LengthBytes ))
  88         {
  89                 eDebug("eSocket_UI::answerEnq failed");
  90                 return -1;
  91         }
  92         return 0;
  93 }
  94
  95 int eSocket_UI::cancelEnq(int slot)
  96 {
  97         unsigned char data[]={0x9f,0x88,0x08,0x01,0x00};
  98         if (handler.send_to_mmisock( data, 5 ))
  99         {
 100                 eDebug("eSocket_UI::cancelEnq failed");
 101                 return -1;
 102         }
 103         return 0;
 104 }
 105
 106 int eSocket_UI::getState(int slot)
 107 {
 108         return handler.connected() ? 2 : 0;
 109 }
 110
 111 int eSocket_UI::getMMIState(int slot)
 112 {
 113         return handler.connected();
 114 }
 115
 116 //FIXME: correct "run/startlevel"
 117 eAutoInitP0<eSocket_UI> init_socketui(eAutoInitNumbers::rc, "Socket MMI");
 118
 119 int eSocketMMIHandler::send_to_mmisock( void* buf, size_t len)
 120 {
 121         int ret = write(connfd, buf, len);
 122         if ( ret < 0 )
 123                 eDebug("[eSocketMMIHandler] write (%m)");
 124         else if ( (uint)ret != len )
 125                 eDebug("[eSocketMMIHandler] only %d bytes sent.. %d bytes should be sent", ret, len );
 126         else
 127                 return 0;
 128         return ret;
 129 }
 130
 131 eSocketMMIHandler::eSocketMMIHandler()
 132         :buffer(512), connfd(-1), connsn(0), sockname("/tmp/mmi.socket"), name(0)
 133 {
 134         memset(&servaddr, 0, sizeof(struct sockaddr_un));
 135         servaddr.sun_family = AF_UNIX;
 136         unlink(sockname);
 137         strcpy(servaddr.sun_path, sockname);
 138         clilen = sizeof(servaddr.sun_family) + strlen(servaddr.sun_path);
 139         if ((listenfd = socket(AF_UNIX, SOCK_STREAM, 0)) < 0)
 140         {
 141                 eDebug("[eSocketMMIHandler] socket (%m)");
 142                 return;
 143         }
 144
 145         int val = 1;
 146         if (setsockopt(listenfd, SOL_SOCKET, SO_REUSEADDR, &val, sizeof(val)) == -1)
 147                 eDebug("[eSocketMMIHandler] SO_REUSEADDR (%m)");
 148         else if ((val = fcntl(listenfd, F_GETFL)) == -1)
 149                 eDebug("[eSocketMMIHandler] F_GETFL (%m)");
 150         else if (fcntl(listenfd, F_SETFL, val | O_NONBLOCK) == -1)
 151                 eDebug("[eSocketMMIHandler] F_SETFL (%m)");
 152         else if (bind(listenfd, (struct sockaddr *) &servaddr, clilen) == -1)
 153                 eDebug("[eSocketMMIHandler] bind (%m)");
 154         else if (listen(listenfd, 0) == -1)
 155                 eDebug("[eSocketMMIHandler] listen (%m)");
 156         else {
 157                 listensn = new eSocketNotifier( eApp, listenfd, POLLIN );
 158                 listensn->start();
 159                 CONNECT( listensn->activated, eSocketMMIHandler::listenDataAvail );
 160                 eDebug("[eSocketMMIHandler] created successfully");
 161                 return;
 162         }
 163
 164         close(listenfd);
 165         listenfd = -1;
 166 }
 167
 168 #define CMD_SET_NAME "\x01\x02\x03\x04"
 169
 170 void eSocketMMIHandler::listenDataAvail(int what)
 171 {
 172         if (what & POLLIN) {
 173                 if ( connsn ) {
 174                         eDebug("[eSocketMMIHandler] connsn != NULL");
 175                         return;
 176                 }
 177                 connfd = accept(listenfd, (struct sockaddr *) &servaddr, (socklen_t *) &clilen);
 178                 if (connfd == -1) {
 179                         eDebug("[eSocketMMIHandler] accept (%m)");
 180                         return;
 181                 }
 182
 183                 int val;
 184                 if ((val = fcntl(connfd, F_GETFL)) == -1)
 185                         eDebug("[eSocketMMIHandler] F_GETFL (%m)");
 186                 else if (fcntl(connfd, F_SETFL, val | O_NONBLOCK) == -1)
 187                         eDebug("[eSocketMMIHandler] F_SETFL (%m)");
 188                 else {
 189                         connsn = new eSocketNotifier( eApp, connfd, POLLIN|POLLHUP|POLLERR );
 190                         CONNECT( connsn->activated, eSocketMMIHandler::connDataAvail );
 191                         return;
 192                 }
 193
 194                 close(connfd);
 195                 connfd = -1;
 196         }
 197 }
 198
 199 void eSocketMMIHandler::connDataAvail(int what)
 200 {
 201         if (what & (POLLIN | POLLPRI | POLLRDNORM | POLLRDBAND)) {
 202                 char msgbuffer[4096];
 203                 ssize_t length = read(connfd, msgbuffer, sizeof(msgbuffer));
 204
 205                 if (length == -1) {
 206                         if (errno != EAGAIN) {
 207                                 eDebug("[eSocketMMIHandler] read (%m)");
 208                                 what |= POLLERR;
 209                         }
 210                 } else if (length == 0){
 211                         what |= POLLHUP;
 212                 } else if ((!name) && (length > 4) && (!memcmp(msgbuffer, CMD_SET_NAME, 4))) {
 213                         length -= 4;
 214                         delete [] name;
 215                         name = new char[length + 1];
 216                         memcpy(name, &msgbuffer[4], length);
 217                         name[length] = '\0';
 218                         eDebug("MMI NAME %s", name);
 219                 } else {
 220                         int len = length;
 221                         unsigned char *data = (unsigned char*)msgbuffer;
 222                         int clear = 1;
 223         // If a new message starts, then the previous message
 224         // should already have been processed. Otherwise the
 225         // previous message was incomplete and should therefore
 226         // be deleted.
 227                         if ((len >= 1) && (data[0] != 0x9f))
 228                                 clear = 0;
 229                         if ((len >= 2) && (data[1] != 0x88))
 230                                 clear = 0;
 231                         if (clear)
 232                         {
 233                                 buffer.clear();
 234 #ifdef MMIDEBUG
 235                                 eDebug("clear buffer");
 236 #endif
 237                         }
 238 #ifdef MMIDEBUG
 239                         eDebug("Put to buffer:");
 240                         for (int i=0; i < len; ++i)
 241                                 eDebugNoNewLine("%02x ", data[i]);
 242                         eDebug("\n--------");
 243 #endif
 244                         buffer.write( data, len );
 245
 246                         while ( buffer.size() >= (3 + MIN_LENGTH_BYTES) )
 247                         {
 248                                 unsigned char tmp[3+MAX_LENGTH_BYTES];
 249                                 buffer.peek(tmp, 3+MIN_LENGTH_BYTES);
 250                                 if (tmp[0] != 0x9f || tmp[1] != 0x88)
 251                                 {
 252                                         buffer.skip(1);
 253 #ifdef MMIDEBUG
 254                                         eDebug("skip %02x", tmp[0]);
 255 #endif
 256                                         continue;
 257                                 }
 258                                 if (tmp[3] & 0x80) {
 259                                         int peekLength = (tmp[3] & 0x7f) + 4;
 260                                         if (buffer.size() < peekLength)
 261                                                 continue;
 262                                         buffer.peek(tmp, peekLength);
 263                                 }
 264                                 int size=0;
 265                                 int LengthBytes=eDVBCISession::parseLengthField(tmp+3, size);
 266                                 int messageLength = 3+LengthBytes+size;
 267                                 if ( buffer.size() >= messageLength )
 268                                 {
 269                                         unsigned char dest[messageLength];
 270                                         buffer.read(dest, messageLength);
 271 #ifdef MMIDEBUG
 272                                         eDebug("dump mmi:");
 273                                         for (int i=0; i < messageLength; ++i)
 274                                                 eDebugNoNewLine("%02x ", dest[i]);
 275                                         eDebug("\n--------");
 276 #endif
 277                                         /*emit*/ mmi_progress(0, dest, (const void*)(dest+3+LengthBytes), messageLength-3-LengthBytes);
 278                                 }
 279                         }
 280                 }
 281         }
 282
 283         if (what & (POLLERR | POLLHUP)) {
 284                 eDebug("pollhup/pollerr");
 285                 closeConn();
 286                 /*emit*/ mmi_progress(0, (const unsigned char*)"\x9f\x88\x00", "\x00", 1);
 287         }
 288 }
 289
 290 void eSocketMMIHandler::closeConn()
 291 {
 292         if ( connfd != -1 )
 293         {
 294                 close(connfd);
 295                 connfd=-1;
 296         }
 297         if ( connsn )
 298         {
 299                 delete connsn;
 300                 connsn=0;
 301         }
 302         if ( name )
 303         {
 304                 delete [] name;
 305                 name=0;
 306         }
 307 }
 308
 309 eSocketMMIHandler::~eSocketMMIHandler()
 310 {
 311         closeConn();
 312         delete listensn;
 313         unlink(sockname);
 314 }