15c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner/*
25c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * Copyright (C) 2010 The Android Open Source Project
35c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * All rights reserved.
45c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *
55c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * Redistribution and use in source and binary forms, with or without
65c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * modification, are permitted provided that the following conditions
75c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * are met:
85c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *  * Redistributions of source code must retain the above copyright
95c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *    notice, this list of conditions and the following disclaimer.
105c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *  * Redistributions in binary form must reproduce the above copyright
115c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *    notice, this list of conditions and the following disclaimer in
125c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *    the documentation and/or other materials provided with the
135c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *    distribution.
145c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *
155c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
165c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
175c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
185c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
195c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
205c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
215c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
225c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
235c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
245c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
255c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
265c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * SUCH DAMAGE.
275c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner */
285c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
29eb847bc8666842a3cfc9c06e8458ad1abebebaf0Elliott Hughes#include "../private/libc_logging.h" // Relative path so we can #include this .cpp file for testing.
30eb847bc8666842a3cfc9c06e8458ad1abebebaf0Elliott Hughes#include "../private/ScopedPthreadMutexLocker.h"
31eababde2141c7128155200b213e45291cd876e46Elliott Hughes
32ce6b1abbb1da797e716d8ec03da4e3b6304fd11dDan Albert#include <android/set_abort_message.h>
3318a206c81d9743481e364384affd43306911283dElliott Hughes#include <assert.h>
34870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn#include <ctype.h>
35eababde2141c7128155200b213e45291cd876e46Elliott Hughes#include <errno.h>
360d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes#include <fcntl.h>
378f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes#include <pthread.h>
385c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner#include <stdarg.h>
39eababde2141c7128155200b213e45291cd876e46Elliott Hughes#include <stddef.h>
408f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes#include <stdlib.h>
415c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner#include <string.h>
420d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes#include <sys/mman.h>
430336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn#include <sys/socket.h>
440336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn#include <sys/types.h>
450d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes#include <sys/uio.h>
460336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn#include <sys/un.h>
470336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn#include <time.h>
485c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner#include <unistd.h>
49eababde2141c7128155200b213e45291cd876e46Elliott Hughes
50870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn#define _REALLY_INCLUDE_SYS__SYSTEM_PROPERTIES_H_
51870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn#include <sys/_system_properties.h>
52870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
530d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes// Must be kept in sync with frameworks/base/core/java/android/util/EventLog.java.
540d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesenum AndroidEventLogType {
550d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  EVENT_TYPE_INT      = 0,
560d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  EVENT_TYPE_LONG     = 1,
570d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  EVENT_TYPE_STRING   = 2,
580d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  EVENT_TYPE_LIST     = 3,
5911331f60dd735613eee902b43a02b646ae873032Jeff Brown  EVENT_TYPE_FLOAT    = 4,
6018a206c81d9743481e364384affd43306911283dElliott Hughes};
615c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
620d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesstruct BufferOutputStream {
630d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes public:
640d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  BufferOutputStream(char* buffer, size_t size) : total(0) {
650d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    buffer_ = buffer;
660d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    end_ = buffer + size - 1;
670d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    pos_ = buffer_;
680d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    pos_[0] = '\0';
690d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  }
705c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
710d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  ~BufferOutputStream() {
720d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  }
730d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
740d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  void Send(const char* data, int len) {
7518a206c81d9743481e364384affd43306911283dElliott Hughes    if (len < 0) {
760d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      len = strlen(data);
7718a206c81d9743481e364384affd43306911283dElliott Hughes    }
785c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
79416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes    total += len;
80416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes
815c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    while (len > 0) {
820d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      int avail = end_ - pos_;
830d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      if (avail == 0) {
84416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes        return;
850d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      }
860d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      if (avail > len) {
870d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes        avail = len;
880d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      }
890d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      memcpy(pos_, data, avail);
900d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      pos_ += avail;
910d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      pos_[0] = '\0';
920d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      len -= avail;
935c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    }
940d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  }
955c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
96416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes  size_t total;
975c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
980d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes private:
990d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  char* buffer_;
1000d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  char* pos_;
1010d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  char* end_;
1020d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes};
1035c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1040d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesstruct FdOutputStream {
1050d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes public:
10662e3a078aa7b156139b1a2cec77e1a84eb10c5a4Chih-Hung Hsieh  explicit FdOutputStream(int fd) : total(0), fd_(fd) {
1071e980b6bc8315d00a07312b25486531247abd98cElliott Hughes  }
1085c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1090d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  void Send(const char* data, int len) {
1100d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    if (len < 0) {
1110d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      len = strlen(data);
1120d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    }
1138f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes
114416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes    total += len;
115416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes
1160d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    while (len > 0) {
1170d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      int rc = TEMP_FAILURE_RETRY(write(fd_, data, len));
1180d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      if (rc == -1) {
119416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes        return;
1200d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      }
1210d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      data += rc;
1220d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      len -= rc;
1235c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    }
1241e980b6bc8315d00a07312b25486531247abd98cElliott Hughes  }
1255c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
126416d7ddaff0946d480b6aa945a741b3eeaca5569Elliott Hughes  size_t total;
1275c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1280d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes private:
1290d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  int fd_;
1300d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes};
1315c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1325c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner/*** formatted output implementation
1335c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner ***/
1345c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1355c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner/* Parse a decimal string from 'format + *ppos',
1365c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * return the value, and writes the new position past
1375c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * the decimal string in '*ppos' on exit.
1385c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner *
1395c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner * NOTE: Does *not* handle a sign prefix.
1405c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner */
1410d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesstatic unsigned parse_decimal(const char *format, int *ppos) {
1425c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    const char* p = format + *ppos;
1435c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    unsigned result = 0;
1445c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1455c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    for (;;) {
1465c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        int ch = *p;
1470336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn        unsigned d = static_cast<unsigned>(ch - '0');
1485c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1490d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes        if (d >= 10U) {
1505c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
1510d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes        }
1525c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
1535c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        result = result*10 + d;
1545c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        p++;
1555c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    }
1565c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    *ppos = p - format;
1575c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    return result;
1585c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner}
1595c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
160eababde2141c7128155200b213e45291cd876e46Elliott Hughes// Writes number 'value' in base 'base' into buffer 'buf' of size 'buf_size' bytes.
161eababde2141c7128155200b213e45291cd876e46Elliott Hughes// Assumes that buf_size > 0.
16241b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughesstatic void format_unsigned(char* buf, size_t buf_size, uint64_t value, int base, bool caps) {
163eababde2141c7128155200b213e45291cd876e46Elliott Hughes  char* p = buf;
164eababde2141c7128155200b213e45291cd876e46Elliott Hughes  char* end = buf + buf_size - 1;
165eababde2141c7128155200b213e45291cd876e46Elliott Hughes
166eababde2141c7128155200b213e45291cd876e46Elliott Hughes  // Generate digit string in reverse order.
167eababde2141c7128155200b213e45291cd876e46Elliott Hughes  while (value) {
168eababde2141c7128155200b213e45291cd876e46Elliott Hughes    unsigned d = value % base;
169eababde2141c7128155200b213e45291cd876e46Elliott Hughes    value /= base;
170eababde2141c7128155200b213e45291cd876e46Elliott Hughes    if (p != end) {
171eababde2141c7128155200b213e45291cd876e46Elliott Hughes      char ch;
172eababde2141c7128155200b213e45291cd876e46Elliott Hughes      if (d < 10) {
173eababde2141c7128155200b213e45291cd876e46Elliott Hughes        ch = '0' + d;
174eababde2141c7128155200b213e45291cd876e46Elliott Hughes      } else {
175eababde2141c7128155200b213e45291cd876e46Elliott Hughes        ch = (caps ? 'A' : 'a') + (d - 10);
176eababde2141c7128155200b213e45291cd876e46Elliott Hughes      }
177eababde2141c7128155200b213e45291cd876e46Elliott Hughes      *p++ = ch;
1785c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    }
179eababde2141c7128155200b213e45291cd876e46Elliott Hughes  }
1805c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
181eababde2141c7128155200b213e45291cd876e46Elliott Hughes  // Special case for 0.
182eababde2141c7128155200b213e45291cd876e46Elliott Hughes  if (p == buf) {
183eababde2141c7128155200b213e45291cd876e46Elliott Hughes    if (p != end) {
184eababde2141c7128155200b213e45291cd876e46Elliott Hughes      *p++ = '0';
1855c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    }
186eababde2141c7128155200b213e45291cd876e46Elliott Hughes  }
187eababde2141c7128155200b213e45291cd876e46Elliott Hughes  *p = '\0';
188eababde2141c7128155200b213e45291cd876e46Elliott Hughes
189eababde2141c7128155200b213e45291cd876e46Elliott Hughes  // Reverse digit string in-place.
190eababde2141c7128155200b213e45291cd876e46Elliott Hughes  size_t length = p - buf;
191eababde2141c7128155200b213e45291cd876e46Elliott Hughes  for (size_t i = 0, j = length - 1; i < j; ++i, --j) {
192eababde2141c7128155200b213e45291cd876e46Elliott Hughes    char ch = buf[i];
193eababde2141c7128155200b213e45291cd876e46Elliott Hughes    buf[i] = buf[j];
194eababde2141c7128155200b213e45291cd876e46Elliott Hughes    buf[j] = ch;
195eababde2141c7128155200b213e45291cd876e46Elliott Hughes  }
1965c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner}
1975c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
19841b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughesstatic void format_integer(char* buf, size_t buf_size, uint64_t value, char conversion) {
19941b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  // Decode the conversion specifier.
20041b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  int is_signed = (conversion == 'd' || conversion == 'i' || conversion == 'o');
20141b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  int base = 10;
20241b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  if (conversion == 'x' || conversion == 'X') {
20341b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes    base = 16;
20441b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  } else if (conversion == 'o') {
20541b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes    base = 8;
20641b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  }
20741b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  bool caps = (conversion == 'X');
2085c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
20941b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  if (is_signed && static_cast<int64_t>(value) < 0) {
21041b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes    buf[0] = '-';
21141b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes    buf += 1;
21241b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes    buf_size -= 1;
21341b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes    value = static_cast<uint64_t>(-static_cast<int64_t>(value));
21441b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  }
21541b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes  format_unsigned(buf, buf_size, value, base, caps);
2165c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner}
2175c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2180d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughestemplate <typename Out>
2190d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesstatic void SendRepeat(Out& o, char ch, int count) {
2200d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  char pad[8];
2210d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  memset(pad, ch, sizeof(pad));
2220d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
2230d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  const int pad_size = static_cast<int>(sizeof(pad));
2240d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  while (count > 0) {
2250d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    int avail = count;
2260d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    if (avail > pad_size) {
2270d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes      avail = pad_size;
2280d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    }
2290d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    o.Send(pad, avail);
2300d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes    count -= avail;
2310d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  }
2320d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes}
2330d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
2345c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner/* Perform formatted output to an output target 'o' */
2350d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughestemplate <typename Out>
2360d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesstatic void out_vformat(Out& o, const char* format, va_list args) {
237ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden    int nn = 0;
2385c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2395c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    for (;;) {
240ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        int mm;
241ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        int padZero = 0;
242ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        int padLeft = 0;
243ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        char sign = '\0';
244ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        int width = -1;
245ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        int prec  = -1;
246ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        size_t bytelen = sizeof(int);
247ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        int slen;
248ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden        char buffer[32];  /* temporary buffer used to format numbers */
249ec92af8fe5d28c74f3505932135b1b8f3fbaad00Andy McFadden
2505c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        char  c;
2515c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2525c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* first, find all characters that are not 0 or '%' */
2535c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* then send them to the output directly */
2545c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        mm = nn;
2555c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        do {
2565c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[mm];
2575c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            if (c == '\0' || c == '%')
2585c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                break;
2595c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            mm++;
2605c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        } while (1);
2615c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2625c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if (mm > nn) {
2630d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes            o.Send(format+nn, mm-nn);
2645c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            nn = mm;
2655c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
2665c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2675c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* is this it ? then exit */
2685c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if (c == '\0')
2695c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
2705c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2715c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* nope, we are at a '%' modifier */
2725c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        nn++;  // skip it
2735c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2745c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* parse flags */
2755c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        for (;;) {
2765c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
2775c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            if (c == '\0') {  /* single trailing '%' ? */
2785c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                c = '%';
2790d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes                o.Send(&c, 1);
2805c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                return;
2815c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
2825c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            else if (c == '0') {
2835c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                padZero = 1;
2845c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                continue;
2855c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
2865c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            else if (c == '-') {
2875c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                padLeft = 1;
2885c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                continue;
2895c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
2905c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            else if (c == ' ' || c == '+') {
2915c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                sign = c;
2925c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                continue;
2935c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
2945c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
2955c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
2965c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
2975c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* parse field width */
2985c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if ((c >= '0' && c <= '9')) {
2995c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            nn --;
3000336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn            width = static_cast<int>(parse_decimal(format, &nn));
3015c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
3025c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
3035c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3045c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* parse precision */
3055c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if (c == '.') {
3060336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn            prec = static_cast<int>(parse_decimal(format, &nn));
3075c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
3085c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
3095c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3105c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* length modifier */
3115c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        switch (c) {
3125c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        case 'h':
3135c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            bytelen = sizeof(short);
3145c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            if (format[nn] == 'h') {
3155c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                bytelen = sizeof(char);
3165c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                nn += 1;
3175c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
3185c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
3195c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
3205c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        case 'l':
3215c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            bytelen = sizeof(long);
3225c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            if (format[nn] == 'l') {
3235c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                bytelen = sizeof(long long);
3245c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                nn += 1;
3255c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
3265c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
3275c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
3285c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        case 'z':
3295c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            bytelen = sizeof(size_t);
3305c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
3315c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
3325c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        case 't':
3335c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            bytelen = sizeof(ptrdiff_t);
3345c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            c = format[nn++];
3355c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            break;
3365c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        default:
3375c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            ;
3385c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
3395c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3405c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* conversion specifier */
34141b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes        const char* str = buffer;
3425c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if (c == 's') {
3435c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* string */
3445c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            str = va_arg(args, const char*);
345239e7a0756fddf3698bf72cab10d7f382421090bElliott Hughes            if (str == NULL) {
346239e7a0756fddf3698bf72cab10d7f382421090bElliott Hughes                str = "(null)";
347239e7a0756fddf3698bf72cab10d7f382421090bElliott Hughes            }
3485c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        } else if (c == 'c') {
3495c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* character */
3505c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* NOTE: char is promoted to int when passed through the stack */
3510336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn            buffer[0] = static_cast<char>(va_arg(args, int));
3525c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            buffer[1] = '\0';
3535c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        } else if (c == 'p') {
3540336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn            uint64_t  value = reinterpret_cast<uintptr_t>(va_arg(args, void*));
3555c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            buffer[0] = '0';
3565c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            buffer[1] = 'x';
35741b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            format_integer(buffer + 2, sizeof(buffer) - 2, value, 'x');
358885f3b9cad01b8158aadc55c159c17dbf34f622cChristopher Ferris        } else if (c == 'd' || c == 'i' || c == 'o' || c == 'u' || c == 'x' || c == 'X') {
3595c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* integers - first read value from stack */
3605c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            uint64_t value;
36141b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            int is_signed = (c == 'd' || c == 'i' || c == 'o');
3625c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3635c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* NOTE: int8_t and int16_t are promoted to int when passed
3645c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner             *       through the stack
3655c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner             */
3665c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            switch (bytelen) {
3670336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn            case 1: value = static_cast<uint8_t>(va_arg(args, int)); break;
3680336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn            case 2: value = static_cast<uint16_t>(va_arg(args, int)); break;
3695c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            case 4: value = va_arg(args, uint32_t); break;
3705c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            case 8: value = va_arg(args, uint64_t); break;
3715c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            default: return;  /* should not happen */
3725c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
3735c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3745c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* sign extension, if needed */
37541b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            if (is_signed) {
3765c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner                int shift = 64 - 8*bytelen;
3770336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn                value = static_cast<uint64_t>((static_cast<int64_t>(value << shift)) >> shift);
3785c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            }
3795c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3805c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            /* format the number properly into our buffer */
38141b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            format_integer(buffer, sizeof(buffer), value, c);
38241b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes        } else if (c == '%') {
38341b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            buffer[0] = '%';
38441b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            buffer[1] = '\0';
38541b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes        } else {
38641b3179c9ef03ebb447cac7f5e8405dce399cb17Elliott Hughes            __assert(__FILE__, __LINE__, "conversion specifier unsupported");
3875c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
3885c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3895c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        /* if we are here, 'str' points to the content that must be
3905c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner         * outputted. handle padding and alignment now */
3915c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
3925c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        slen = strlen(str);
3935c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
39418a206c81d9743481e364384affd43306911283dElliott Hughes        if (sign != '\0' || prec != -1) {
39518a206c81d9743481e364384affd43306911283dElliott Hughes            __assert(__FILE__, __LINE__, "sign/precision unsupported");
39618a206c81d9743481e364384affd43306911283dElliott Hughes        }
39718a206c81d9743481e364384affd43306911283dElliott Hughes
3985c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if (slen < width && !padLeft) {
3995c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            char padChar = padZero ? '0' : ' ';
4000d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes            SendRepeat(o, padChar, width - slen);
4015c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
4025c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
4030d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes        o.Send(str, slen);
4045c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner
4055c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        if (slen < width && padLeft) {
4065c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner            char padChar = padZero ? '0' : ' ';
4070d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes            SendRepeat(o, padChar, width - slen);
4085c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner        }
4095c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner    }
4105c734644eebf8d01be1e86cbe20a111a5c5a2738David 'Digit' Turner}
4118f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes
4120d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesint __libc_format_buffer(char* buffer, size_t buffer_size, const char* format, ...) {
4130d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  BufferOutputStream os(buffer, buffer_size);
4140d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_list args;
4150d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_start(args, format);
4160d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  out_vformat(os, format, args);
4170d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_end(args);
4180d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  return os.total;
4190d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes}
4200d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
421273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gaoint __libc_format_buffer_va_list(char* buffer, size_t buffer_size, const char* format,
422273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gao                                 va_list args) {
423273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gao  BufferOutputStream os(buffer, buffer_size);
424273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gao  out_vformat(os, format, args);
425273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gao  return os.total;
426273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gao}
427273991ceadac558ba3bca5238d81833a7b34cb2dJosh Gao
4280d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesint __libc_format_fd(int fd, const char* format, ...) {
4290d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  FdOutputStream os(fd);
4300d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_list args;
4310d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_start(args, format);
4320d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  out_vformat(os, format, args);
4330d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_end(args);
4340d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  return os.total;
4350d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes}
4360d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
4370f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughesstatic int __libc_write_stderr(const char* tag, const char* msg) {
4380f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  iovec vec[4];
4390f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[0].iov_base = const_cast<char*>(tag);
4400f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[0].iov_len = strlen(tag);
4410f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[1].iov_base = const_cast<char*>(": ");
4420f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[1].iov_len = 2;
4430f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[2].iov_base = const_cast<char*>(msg);
44442084a265329538a9e696e41971fb5d6abe3c14fElliott Hughes  vec[2].iov_len = strlen(msg);
4450f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[3].iov_base = const_cast<char*>("\n");
4460f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  vec[3].iov_len = 1;
4470f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes
44859bde2e8f4dacc059beb7269b86b276ec091ad57Josh Gao  int result = TEMP_FAILURE_RETRY(writev(STDERR_FILENO, vec, 4));
4490f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes  return result;
4500f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes}
4510f395b7ba056ccec3915737cfece81ca2161e980Elliott Hughes
45242084a265329538a9e696e41971fb5d6abe3c14fElliott Hughesstatic int __libc_open_log_socket() {
4530336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  // ToDo: Ideally we want this to fail if the gid of the current
4540336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  // process is AID_LOGD, but will have to wait until we have
4550336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  // registered this in private/android_filesystem_config.h. We have
4560336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  // found that all logd crashes thus far have had no problem stuffing
4570336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  // the UNIX domain socket and moving on so not critical *today*.
4580336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn
4590f67d5ffa41ecc73f52e81f18f2a10229cc33de5Elliott Hughes  int log_fd = TEMP_FAILURE_RETRY(socket(PF_UNIX, SOCK_DGRAM | SOCK_CLOEXEC | SOCK_NONBLOCK, 0));
4600f67d5ffa41ecc73f52e81f18f2a10229cc33de5Elliott Hughes  if (log_fd == -1) {
4610336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    return -1;
4620336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  }
4630336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn
4640336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  union {
4650336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    struct sockaddr    addr;
4660336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    struct sockaddr_un addrUn;
4670336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  } u;
4680336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  memset(&u, 0, sizeof(u));
4690336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  u.addrUn.sun_family = AF_UNIX;
4700336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  strlcpy(u.addrUn.sun_path, "/dev/socket/logdw", sizeof(u.addrUn.sun_path));
4710336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn
4720336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  if (TEMP_FAILURE_RETRY(connect(log_fd, &u.addr, sizeof(u.addrUn))) != 0) {
4730336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    close(log_fd);
4740336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    return -1;
4750336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  }
4760336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn
4770336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  return log_fd;
4780336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn}
4799fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn
480870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzynstruct cache {
481870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  const prop_info* pinfo;
482870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  uint32_t serial;
483870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  char c;
484870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn};
485870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
486870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzynstatic void refresh_cache(struct cache *cache, const char *key)
487870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn{
488870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  if (!cache->pinfo) {
489870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    cache->pinfo = __system_property_find(key);
490870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    if (!cache->pinfo) {
491870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn      return;
492870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    }
493870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  }
494870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  uint32_t serial = __system_property_serial(cache->pinfo);
495870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  if (serial == cache->serial) {
496870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    return;
497870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  }
498870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  cache->serial = serial;
499870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
500870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  char buf[PROP_VALUE_MAX];
501870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  __system_property_read(cache->pinfo, 0, buf);
502870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  cache->c = buf[0];
503870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn}
504870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
505870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn// Timestamp state generally remains constant, since a change is
506870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn// rare, we can accept a trylock failure gracefully.
507870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzynstatic pthread_mutex_t lock_clockid = PTHREAD_MUTEX_INITIALIZER;
508870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
5099da687e2f49c2a67135bf30d074de445728e109dMark Salyzynstatic clockid_t __android_log_clockid()
510870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn{
511870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  static struct cache r_time_cache = { NULL, static_cast<uint32_t>(-1), 0 };
512870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  static struct cache p_time_cache = { NULL, static_cast<uint32_t>(-1), 0 };
513870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  char c;
514870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
515870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  if (pthread_mutex_trylock(&lock_clockid)) {
516870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    // We are willing to accept some race in this context
517870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    if (!(c = p_time_cache.c)) {
518870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn      c = r_time_cache.c;
519870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    }
520870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  } else {
521870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    static uint32_t serial;
522870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    uint32_t current_serial = __system_property_area_serial();
523870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    if (current_serial != serial) {
524870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn      refresh_cache(&r_time_cache, "ro.logd.timestamp");
525870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn      refresh_cache(&p_time_cache, "persist.logd.timestamp");
526870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn      serial = current_serial;
527870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    }
528870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    if (!(c = p_time_cache.c)) {
529870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn      c = r_time_cache.c;
530870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    }
531870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
532870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn    pthread_mutex_unlock(&lock_clockid);
533870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  }
534870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
535870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn  return (tolower(c) == 'm') ? CLOCK_MONOTONIC : CLOCK_REALTIME;
536870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn}
537870f165ceb3348d79499d40ce8b629f62a15ff2bMark Salyzyn
5389fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzynstruct log_time { // Wire format
5399fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn  uint32_t tv_sec;
5409fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn  uint32_t tv_nsec;
5419fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn};
5420336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn
5432c75991359df165ca7cc7a6213fb227c0b5ed87cColin Crossint __libc_write_log(int priority, const char* tag, const char* msg) {
5440336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  int main_log_fd = __libc_open_log_socket();
5450336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  if (main_log_fd == -1) {
5460336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    // Try stderr instead.
5470336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn    return __libc_write_stderr(tag, msg);
5480336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  }
5490336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn
5508664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  iovec vec[6];
551011101905d91b770893e8a2fb6c09552d1c63652Elliott Hughes  char log_id = (priority == ANDROID_LOG_FATAL) ? LOG_ID_CRASH : LOG_ID_MAIN;
5520336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  vec[0].iov_base = &log_id;
5530336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  vec[0].iov_len = sizeof(log_id);
5548664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  uint16_t tid = gettid();
5558664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[1].iov_base = &tid;
5568664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[1].iov_len = sizeof(tid);
5579fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn  timespec ts;
5589da687e2f49c2a67135bf30d074de445728e109dMark Salyzyn  clock_gettime(__android_log_clockid(), &ts);
5599fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn  log_time realtime_ts;
5609fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn  realtime_ts.tv_sec = ts.tv_sec;
5619fc76027f3e1e02193f3dd98063c55918e1b4066Mark Salyzyn  realtime_ts.tv_nsec = ts.tv_nsec;
5628664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[2].iov_base = &realtime_ts;
5638664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[2].iov_len = sizeof(realtime_ts);
5648664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn
5658664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[3].iov_base = &priority;
5668664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[3].iov_len = 1;
5678664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[4].iov_base = const_cast<char*>(tag);
568aba6f712d46577c45a89fd0626dc251885d7989dElliott Hughes  vec[4].iov_len = strlen(tag) + 1;
5698664be583a4556e5ca132288e989d307d2df92ceMark Salyzyn  vec[5].iov_base = const_cast<char*>(msg);
570aba6f712d46577c45a89fd0626dc251885d7989dElliott Hughes  vec[5].iov_len = strlen(msg) + 1;
5710d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
5720336e35368aa161f1fed04ccde39553db4740b97Mark Salyzyn  int result = TEMP_FAILURE_RETRY(writev(main_log_fd, vec, sizeof(vec) / sizeof(vec[0])));
57317fc25d20f4d61f7fc3dfb3de095719ada89e38bNick Kralevich  close(main_log_fd);
57417fc25d20f4d61f7fc3dfb3de095719ada89e38bNick Kralevich  return result;
5750d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes}
5760d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
5770d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesint __libc_format_log_va_list(int priority, const char* tag, const char* format, va_list args) {
5780d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  char buffer[1024];
5790d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  BufferOutputStream os(buffer, sizeof(buffer));
5800d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  out_vformat(os, format, args);
5810d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  return __libc_write_log(priority, tag, buffer);
5820d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes}
5830d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
5840d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughesint __libc_format_log(int priority, const char* tag, const char* format, ...) {
5850d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_list args;
5860d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_start(args, format);
5870d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  int result = __libc_format_log_va_list(priority, tag, format, args);
5880d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  va_end(args);
5890d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  return result;
5900d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes}
5918f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes
592b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughesstatic void __libc_fatal_va_list(const char* prefix, const char* format, va_list args) {
593b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  char msg[1024];
594b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  BufferOutputStream os(msg, sizeof(msg));
5958f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes
596b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  if (prefix) {
597b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes    os.Send(prefix, strlen(prefix));
598b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes    os.Send(": ", 2);
5998f2a5a0b40fc82126c691d5c30131d908772aab7Elliott Hughes  }
6000d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
6010d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  out_vformat(os, format, args);
6020d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
6035e6cf05aab0a2fcc6177482606c1b1f2d958a7f9Elliott Hughes  // Log to stderr for the benefit of "adb shell" users and gtests.
60497e31dedf056b07bcfcd46c49b60bf0798c60843Dan Albert  struct iovec iov[2] = {
60542084a265329538a9e696e41971fb5d6abe3c14fElliott Hughes    { msg, os.total },
60642084a265329538a9e696e41971fb5d6abe3c14fElliott Hughes    { const_cast<char*>("\n"), 1 },
60797e31dedf056b07bcfcd46c49b60bf0798c60843Dan Albert  };
60842084a265329538a9e696e41971fb5d6abe3c14fElliott Hughes  TEMP_FAILURE_RETRY(writev(2, iov, 2));
6090d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
6100d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes  // Log to the log for the benefit of regular app developers (whose stdout and stderr are closed).
611c78368f04faa4ee17f546985809e7550f3f88636Elliott Hughes  __libc_write_log(ANDROID_LOG_FATAL, "libc", msg);
6120d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
613ce6b1abbb1da797e716d8ec03da4e3b6304fd11dDan Albert  android_set_abort_message(msg);
61461e699a133a4807fe878a6cb0d7190d7c96e21f8Elliott Hughes}
61561e699a133a4807fe878a6cb0d7190d7c96e21f8Elliott Hughes
616b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughesvoid __libc_fatal(const char* fmt, ...) {
61761e699a133a4807fe878a6cb0d7190d7c96e21f8Elliott Hughes  va_list args;
618b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  va_start(args, fmt);
619b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  __libc_fatal_va_list(nullptr, fmt, args);
62061e699a133a4807fe878a6cb0d7190d7c96e21f8Elliott Hughes  va_end(args);
621b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  abort();
62261e699a133a4807fe878a6cb0d7190d7c96e21f8Elliott Hughes}
6230d787c1fa18c6a1f29ef9840e28a68cf077be1deElliott Hughes
624b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughesvoid __fortify_fatal(const char* fmt, ...) {
62561e699a133a4807fe878a6cb0d7190d7c96e21f8Elliott Hughes  va_list args;
626b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  va_start(args, fmt);
627b83d6747facc5d819a0df0bcb8762477eecfd962Elliott Hughes  __libc_fatal_va_list("FORTIFY", fmt, args);
6282e3b7108b5b3d3f3a4a0fb369016e854bcf92212Elliott Hughes  va_end(args);
6292e3b7108b5b3d3f3a4a0fb369016e854bcf92212Elliott Hughes  abort();
6302e3b7108b5b3d3f3a4a0fb369016e854bcf92212Elliott Hughes}
631