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