qemu/qemu.c

   1 /*
   2  * Copyright (C) 2008 The Android Open Source Project
   3  *
   4  * Licensed under the Apache License, Version 2.0 (the "License");
   5  * you may not use this file except in compliance with the License.
   6  * You may obtain a copy of the License at
   7  *
   8  *      http://www.apache.org/licenses/LICENSE-2.0
   9  *
  10  * Unless required by applicable law or agreed to in writing, software
  11  * distributed under the License is distributed on an "AS IS" BASIS,
  12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13  * See the License for the specific language governing permissions and
  14  * limitations under the License.
  15  */
  16
  17 /* this file contains various functions used by all libhardware modules
  18  * that support QEMU emulation
  19  */
  20 #include "qemu.h"
  21 #define  LOG_TAG  "hardware-qemu"
  22 #include <cutils/log.h>
  23 #include <cutils/properties.h>
  24 #include <cutils/sockets.h>
  25 #include <errno.h>
  26 #include <fcntl.h>
  27 #include <termios.h>
  28 #include <stdio.h>
  29 #include <stdarg.h>
  30
  31 #define  QEMU_DEBUG  0
  32
  33 #if QEMU_DEBUG
  34 #  define  D(...)   ALOGD(__VA_ARGS__)
  35 #else
  36 #  define  D(...)   ((void)0)
  37 #endif
  38
  39 #include "hardware/qemu_pipe.h"
  40
  41 int
  42 qemu_check(void)
  43 {
  44     static int  in_qemu = -1;
  45
  46     if (__builtin_expect(in_qemu < 0,0)) {
  47         char  propBuf[PROPERTY_VALUE_MAX];
  48         property_get("ro.kernel.qemu", propBuf, "");
  49         in_qemu = (propBuf[0] == '1');
  50     }
  51     return in_qemu;
  52 }
  53
  54 static int
  55 qemu_fd_write( int  fd, const char*  cmd, int  len )
  56 {
  57     int  len2;
  58     do {
  59         len2 = write(fd, cmd, len);
  60     } while (len2 < 0 && errno == EINTR);
  61     return len2;
  62 }
  63
  64 static int
  65 qemu_fd_read( int  fd, char*  buff, int  len )
  66 {
  67     int  len2;
  68     do {
  69         len2 = read(fd, buff, len);
  70     } while (len2 < 0 && errno == EINTR);
  71     return len2;
  72 }
  73
  74 static int
  75 qemu_channel_open_qemud_pipe( QemuChannel*  channel,
  76                               const char*   name )
  77 {
  78     int   fd;
  79     char  pipe_name[512];
  80
  81     snprintf(pipe_name, sizeof(pipe_name), "qemud:%s", name);
  82     fd = qemu_pipe_open(pipe_name);
  83     if (fd < 0) {
  84         D("no qemud pipe: %s", strerror(errno));
  85         return -1;
  86     }
  87
  88     channel->is_qemud = 1;
  89     channel->fd       = fd;
  90     return 0;
  91 }
  92
  93 static int
  94 qemu_channel_open_qemud( QemuChannel*  channel,
  95                          const char*   name )
  96 {
  97     int   fd, ret, namelen = strlen(name);
  98     char  answer[2];
  99
 100     fd = socket_local_client( "qemud",
 101                               ANDROID_SOCKET_NAMESPACE_RESERVED,
 102                               SOCK_STREAM );
 103     if (fd < 0) {
 104         D("no qemud control socket: %s", strerror(errno));
 105         return -1;
 106     }
 107
 108     /* send service name to connect */
 109     if (qemu_fd_write(fd, name, namelen) != namelen) {
 110         D("can't send service name to qemud: %s",
 111            strerror(errno));
 112         close(fd);
 113         return -1;
 114     }
 115
 116     /* read answer from daemon */
 117     if (qemu_fd_read(fd, answer, 2) != 2 ||
 118         answer[0] != 'O' || answer[1] != 'K') {
 119         D("cant' connect to %s service through qemud", name);
 120         close(fd);
 121         return -1;
 122     }
 123
 124     channel->is_qemud = 1;
 125     channel->fd       = fd;
 126     return 0;
 127 }
 128
 129
 130 static int
 131 qemu_channel_open_qemud_old( QemuChannel*  channel,
 132                              const char*   name )
 133 {
 134     int  fd;
 135
 136     snprintf(channel->device, sizeof channel->device,
 137                 "qemud_%s", name);
 138
 139     fd = socket_local_client( channel->device,
 140                               ANDROID_SOCKET_NAMESPACE_RESERVED,
 141                               SOCK_STREAM );
 142     if (fd < 0) {
 143         D("no '%s' control socket available: %s",
 144             channel->device, strerror(errno));
 145         return -1;
 146     }
 147
 148     close(fd);
 149     channel->is_qemud_old = 1;
 150     return 0;
 151 }
 152
 153
 154 static int
 155 qemu_channel_open_tty( QemuChannel*  channel,
 156                        const char*   name,
 157                        int           mode )
 158 {
 159     char   key[PROPERTY_KEY_MAX];
 160     char   prop[PROPERTY_VALUE_MAX];
 161     int    ret;
 162
 163     ret = snprintf(key, sizeof key, "ro.kernel.android.%s", name);
 164     if (ret >= (int)sizeof key)
 165         return -1;
 166
 167     if (property_get(key, prop, "") == 0) {
 168         D("no kernel-provided %s device name", name);
 169         return -1;
 170     }
 171
 172     ret = snprintf(channel->device, sizeof channel->device,
 173                     "/dev/%s", prop);
 174     if (ret >= (int)sizeof channel->device) {
 175         D("%s device name too long: '%s'", name, prop);
 176         return -1;
 177     }
 178
 179     channel->is_tty = !memcmp("/dev/tty", channel->device, 8);
 180     return 0;
 181 }
 182
 183 int
 184 qemu_channel_open( QemuChannel*  channel,
 185                    const char*   name,
 186                    int           mode )
 187 {
 188     int  fd = -1;
 189
 190     /* initialize the channel is needed */
 191     if (!channel->is_inited)
 192     {
 193         channel->is_inited = 1;
 194
 195         do {
 196             if (qemu_channel_open_qemud_pipe(channel, name) == 0)
 197                 break;
 198
 199             if (qemu_channel_open_qemud(channel, name) == 0)
 200                 break;
 201
 202             if (qemu_channel_open_qemud_old(channel, name) == 0)
 203                 break;
 204
 205             if (qemu_channel_open_tty(channel, name, mode) == 0)
 206                 break;
 207
 208             channel->is_available = 0;
 209             return -1;
 210         } while (0);
 211
 212         channel->is_available = 1;
 213     }
 214
 215     /* try to open the file */
 216     if (!channel->is_available) {
 217         errno = ENOENT;
 218         return -1;
 219     }
 220
 221     if (channel->is_qemud) {
 222         return dup(channel->fd);
 223     }
 224
 225     if (channel->is_qemud_old) {
 226         do {
 227             fd = socket_local_client( channel->device,
 228                                       ANDROID_SOCKET_NAMESPACE_RESERVED,
 229                                       SOCK_STREAM );
 230         } while (fd < 0 && errno == EINTR);
 231     }
 232     else /* /dev/ttySn ? */
 233     {
 234         do {
 235             fd = open(channel->device, mode);
 236         } while (fd < 0 && errno == EINTR);
 237
 238         /* disable ECHO on serial lines */
 239         if (fd >= 0 && channel->is_tty) {
 240             struct termios  ios;
 241             tcgetattr( fd, &ios );
 242             ios.c_lflag = 0;  /* disable ECHO, ICANON, etc... */
 243             tcsetattr( fd, TCSANOW, &ios );
 244         }
 245     }
 246     return fd;
 247 }
 248
 249
 250 static int
 251 qemu_command_vformat( char*        buffer,
 252                       int          buffer_size,
 253                       const char*  format,
 254                       va_list      args )
 255 {
 256     char     header[5];
 257     int      len;
 258
 259     if (buffer_size < 6)
 260         return -1;
 261
 262     len = vsnprintf(buffer+4, buffer_size-4, format, args);
 263     if (len >= buffer_size-4)
 264         return -1;
 265
 266     snprintf(header, sizeof header, "%04x", len);
 267     memcpy(buffer, header, 4);
 268     return len + 4;
 269 }
 270
 271 extern int
 272 qemu_command_format( char*        buffer,
 273                      int          buffer_size,
 274                      const char*  format,
 275                      ... )
 276 {
 277     va_list  args;
 278     int      ret;
 279
 280     va_start(args, format);
 281     ret = qemu_command_format(buffer, buffer_size, format, args);
 282     va_end(args);
 283     return ret;
 284 }
 285
 286
 287 static int
 288 qemu_control_fd(void)
 289 {
 290     static QemuChannel  channel[1];
 291     int                 fd;
 292
 293     fd = qemu_channel_open( channel, "hw-control", O_RDWR );
 294     if (fd < 0) {
 295         D("%s: could not open control channel: %s", __FUNCTION__,
 296           strerror(errno));
 297     }
 298     return fd;
 299 }
 300
 301 static int
 302 qemu_control_send(const char*  cmd, int  len)
 303 {
 304     int  fd, len2;
 305
 306     if (len < 0) {
 307         errno = EINVAL;
 308         return -1;
 309     }
 310
 311     fd = qemu_control_fd();
 312     if (fd < 0)
 313         return -1;
 314
 315     len2 = qemu_fd_write(fd, cmd, len);
 316     close(fd);
 317     if (len2 != len) {
 318         D("%s: could not send everything %d < %d",
 319           __FUNCTION__, len2, len);
 320         return -1;
 321     }
 322     return 0;
 323 }
 324
 325
 326 int
 327 qemu_control_command( const char*  fmt, ... )
 328 {
 329     va_list  args;
 330     char     command[256];
 331     int      len, fd;
 332
 333     va_start(args, fmt);
 334     len = qemu_command_vformat( command, sizeof command, fmt, args );
 335     va_end(args);
 336
 337     if (len < 0 || len >= (int)sizeof command) {
 338         if (len < 0) {
 339             D("%s: could not send: %s", __FUNCTION__, strerror(errno));
 340         } else {
 341             D("%s: too large %d > %d", __FUNCTION__, len, (int)(sizeof command));
 342         }
 343         errno = EINVAL;
 344         return -1;
 345     }
 346
 347     return qemu_control_send( command, len );
 348 }
 349
 350 extern int  qemu_control_query( const char*  question, int  questionlen,
 351                                 char*        answer,   int  answersize )
 352 {
 353     int   ret, fd, len, result = -1;
 354     char  header[5], *end;
 355
 356     if (questionlen <= 0) {
 357         errno = EINVAL;
 358         return -1;
 359     }
 360
 361     fd = qemu_control_fd();
 362     if (fd < 0)
 363         return -1;
 364
 365     ret = qemu_fd_write( fd, question, questionlen );
 366     if (ret != questionlen) {
 367         D("%s: could not write all: %d < %d", __FUNCTION__,
 368           ret, questionlen);
 369         goto Exit;
 370     }
 371
 372     /* read a 4-byte header giving the length of the following content */
 373     ret = qemu_fd_read( fd, header, 4 );
 374     if (ret != 4) {
 375         D("%s: could not read header (%d != 4)",
 376           __FUNCTION__, ret);
 377         goto Exit;
 378     }
 379
 380     header[4] = 0;
 381     len = strtol( header, &end,  16 );
 382     if ( len < 0 || end == NULL || end != header+4 || len > answersize ) {
 383         D("%s: could not parse header: '%s'",
 384           __FUNCTION__, header);
 385         goto Exit;
 386     }
 387
 388     /* read the answer */
 389     ret = qemu_fd_read( fd, answer, len );
 390     if (ret != len) {
 391         D("%s: could not read all of answer %d < %d",
 392           __FUNCTION__, ret, len);
 393         goto Exit;
 394     }
 395
 396     result = len;
 397
 398 Exit:
 399     close(fd);
 400     return result;
 401 }