19326d779SJeremy Kerr /** 29326d779SJeremy Kerr * Copyright © 2016 IBM Corporation 39326d779SJeremy Kerr * 49326d779SJeremy Kerr * Licensed under the Apache License, Version 2.0 (the "License"); 59326d779SJeremy Kerr * you may not use this file except in compliance with the License. 69326d779SJeremy Kerr * You may obtain a copy of the License at 79326d779SJeremy Kerr * 89326d779SJeremy Kerr * http://www.apache.org/licenses/LICENSE-2.0 99326d779SJeremy Kerr * 109326d779SJeremy Kerr * Unless required by applicable law or agreed to in writing, software 119326d779SJeremy Kerr * distributed under the License is distributed on an "AS IS" BASIS, 129326d779SJeremy Kerr * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 139326d779SJeremy Kerr * See the License for the specific language governing permissions and 149326d779SJeremy Kerr * limitations under the License. 159326d779SJeremy Kerr */ 163f54de4cSJeremy Kerr 173f54de4cSJeremy Kerr #include <endian.h> 183f54de4cSJeremy Kerr #include <err.h> 193f54de4cSJeremy Kerr #include <fcntl.h> 203f54de4cSJeremy Kerr #include <stdbool.h> 213f54de4cSJeremy Kerr #include <stdio.h> 223f54de4cSJeremy Kerr #include <stdlib.h> 233f54de4cSJeremy Kerr #include <string.h> 243f54de4cSJeremy Kerr #include <unistd.h> 253f54de4cSJeremy Kerr 263f54de4cSJeremy Kerr #include <sys/mman.h> 273f54de4cSJeremy Kerr 283f54de4cSJeremy Kerr #include <linux/types.h> 293f54de4cSJeremy Kerr 303f54de4cSJeremy Kerr #include "console-server.h" 313f54de4cSJeremy Kerr 323f54de4cSJeremy Kerr struct log_handler { 333f54de4cSJeremy Kerr struct handler handler; 343f54de4cSJeremy Kerr struct console *console; 35f733c85aSJeremy Kerr struct ringbuffer_consumer *rbc; 363f54de4cSJeremy Kerr int fd; 373f54de4cSJeremy Kerr size_t size; 383f54de4cSJeremy Kerr size_t maxsize; 393f54de4cSJeremy Kerr int pagesize; 403f54de4cSJeremy Kerr }; 413f54de4cSJeremy Kerr 423f54de4cSJeremy Kerr 43e440a407SJeremy Kerr static const char *default_filename = LOCALSTATEDIR "/log/obmc-console.log"; 44*6424cc3bSKun Yi static const size_t default_logsize = 16 * 1024; 453f54de4cSJeremy Kerr 463f54de4cSJeremy Kerr static struct log_handler *to_log_handler(struct handler *handler) 473f54de4cSJeremy Kerr { 483f54de4cSJeremy Kerr return container_of(handler, struct log_handler, handler); 493f54de4cSJeremy Kerr } 503f54de4cSJeremy Kerr 513f54de4cSJeremy Kerr static int log_trim(struct log_handler *lh, size_t space) 523f54de4cSJeremy Kerr { 533f54de4cSJeremy Kerr int rc, n_shift_pages, shift_len, shift_start; 543f54de4cSJeremy Kerr off_t pos; 553f54de4cSJeremy Kerr void *buf; 563f54de4cSJeremy Kerr 573f54de4cSJeremy Kerr pos = lseek(lh->fd, 0, SEEK_CUR); 583f54de4cSJeremy Kerr 593f54de4cSJeremy Kerr n_shift_pages = (space + lh->pagesize - 1) / lh->pagesize; 603f54de4cSJeremy Kerr shift_start = n_shift_pages * lh->pagesize; 613f54de4cSJeremy Kerr shift_len = pos - (n_shift_pages * lh->pagesize); 623f54de4cSJeremy Kerr 633f54de4cSJeremy Kerr buf = mmap(NULL, pos, PROT_READ | PROT_WRITE, MAP_SHARED, lh->fd, 0); 643f54de4cSJeremy Kerr if (buf == MAP_FAILED) 653f54de4cSJeremy Kerr return -1; 663f54de4cSJeremy Kerr 673f54de4cSJeremy Kerr memmove(buf, buf + shift_start, shift_len); 683f54de4cSJeremy Kerr 693f54de4cSJeremy Kerr munmap(buf, pos); 703f54de4cSJeremy Kerr 713f54de4cSJeremy Kerr lh->size = shift_len; 723f54de4cSJeremy Kerr rc = ftruncate(lh->fd, lh->size); 733f54de4cSJeremy Kerr if (rc) 743f54de4cSJeremy Kerr warn("failed to truncate file"); 753f54de4cSJeremy Kerr lseek(lh->fd, 0, SEEK_END); 763f54de4cSJeremy Kerr 773f54de4cSJeremy Kerr return 0; 783f54de4cSJeremy Kerr 793f54de4cSJeremy Kerr } 803f54de4cSJeremy Kerr 81f733c85aSJeremy Kerr static int log_data(struct log_handler *lh, uint8_t *buf, size_t len) 823f54de4cSJeremy Kerr { 833f54de4cSJeremy Kerr int rc; 843f54de4cSJeremy Kerr 853f54de4cSJeremy Kerr if (len > lh->maxsize) { 863f54de4cSJeremy Kerr buf += len - lh->maxsize; 873f54de4cSJeremy Kerr len = lh->maxsize; 883f54de4cSJeremy Kerr } 893f54de4cSJeremy Kerr 903f54de4cSJeremy Kerr if (lh->size + len > lh->maxsize) { 913f54de4cSJeremy Kerr rc = log_trim(lh, len); 923f54de4cSJeremy Kerr if (rc) 933f54de4cSJeremy Kerr return rc; 943f54de4cSJeremy Kerr } 953f54de4cSJeremy Kerr 963f54de4cSJeremy Kerr rc = write_buf_to_fd(lh->fd, buf, len); 973f54de4cSJeremy Kerr if (rc) 983f54de4cSJeremy Kerr return rc; 993f54de4cSJeremy Kerr 1003f54de4cSJeremy Kerr lh->size += len; 1013f54de4cSJeremy Kerr 1023f54de4cSJeremy Kerr return 0; 1033f54de4cSJeremy Kerr } 1043f54de4cSJeremy Kerr 105f733c85aSJeremy Kerr static enum ringbuffer_poll_ret log_ringbuffer_poll(void *arg, 106f733c85aSJeremy Kerr size_t force_len __attribute__((unused))) 107f733c85aSJeremy Kerr { 108f733c85aSJeremy Kerr struct log_handler *lh = arg; 109f733c85aSJeremy Kerr uint8_t *buf; 110f733c85aSJeremy Kerr size_t len; 111f733c85aSJeremy Kerr int rc; 112f733c85aSJeremy Kerr 113f733c85aSJeremy Kerr /* we log synchronously, so just dequeue everything we can, and 114f733c85aSJeremy Kerr * commit straight away. */ 115f733c85aSJeremy Kerr for (;;) { 116f733c85aSJeremy Kerr len = ringbuffer_dequeue_peek(lh->rbc, 0, &buf); 117f733c85aSJeremy Kerr if (!len) 118f733c85aSJeremy Kerr break; 119f733c85aSJeremy Kerr 120f733c85aSJeremy Kerr rc = log_data(lh, buf, len); 121f733c85aSJeremy Kerr if (rc) 122f733c85aSJeremy Kerr return RINGBUFFER_POLL_REMOVE; 123f733c85aSJeremy Kerr 124f733c85aSJeremy Kerr ringbuffer_dequeue_commit(lh->rbc, len); 125f733c85aSJeremy Kerr } 126f733c85aSJeremy Kerr 127f733c85aSJeremy Kerr return RINGBUFFER_POLL_OK; 128f733c85aSJeremy Kerr } 129f733c85aSJeremy Kerr 130f733c85aSJeremy Kerr static int log_init(struct handler *handler, struct console *console, 131*6424cc3bSKun Yi struct config *config) 132f733c85aSJeremy Kerr { 133f733c85aSJeremy Kerr struct log_handler *lh = to_log_handler(handler); 134*6424cc3bSKun Yi const char *filename, *logsize_str; 135*6424cc3bSKun Yi size_t logsize; 136f733c85aSJeremy Kerr int rc; 137f733c85aSJeremy Kerr 138f733c85aSJeremy Kerr lh->console = console; 139f733c85aSJeremy Kerr lh->pagesize = 4096; 140f733c85aSJeremy Kerr lh->size = 0; 141f733c85aSJeremy Kerr 142*6424cc3bSKun Yi logsize_str = config_get_value(config, "logsize"); 143*6424cc3bSKun Yi rc = config_parse_logsize(logsize_str, &logsize); 144*6424cc3bSKun Yi if (logsize_str != NULL && rc) { 145*6424cc3bSKun Yi logsize = default_logsize; 146*6424cc3bSKun Yi warn("Invalid logsize. Default to %ukB", 147*6424cc3bSKun Yi (unsigned int)(logsize >> 10)); 148*6424cc3bSKun Yi } 149*6424cc3bSKun Yi lh->maxsize = logsize <= lh->pagesize ? lh->pagesize + 1 : logsize; 150*6424cc3bSKun Yi 151f733c85aSJeremy Kerr filename = config_get_value(config, "logfile"); 152f733c85aSJeremy Kerr if (!filename) 153f733c85aSJeremy Kerr filename = default_filename; 154f733c85aSJeremy Kerr 155f733c85aSJeremy Kerr lh->fd = open(filename, O_RDWR | O_CREAT, 0644); 156f733c85aSJeremy Kerr if (lh->fd < 0) { 157f733c85aSJeremy Kerr warn("Can't open log buffer file %s", filename); 158f733c85aSJeremy Kerr return -1; 159f733c85aSJeremy Kerr } 160f733c85aSJeremy Kerr rc = ftruncate(lh->fd, 0); 161f733c85aSJeremy Kerr if (rc) { 162f733c85aSJeremy Kerr warn("Can't truncate file %s", filename); 163f733c85aSJeremy Kerr close(lh->fd); 164f733c85aSJeremy Kerr return -1; 165f733c85aSJeremy Kerr } 166f733c85aSJeremy Kerr 167f733c85aSJeremy Kerr lh->rbc = console_ringbuffer_consumer_register(console, 168f733c85aSJeremy Kerr log_ringbuffer_poll, lh); 169f733c85aSJeremy Kerr 170f733c85aSJeremy Kerr return 0; 171f733c85aSJeremy Kerr } 172f733c85aSJeremy Kerr 1733f54de4cSJeremy Kerr static void log_fini(struct handler *handler) 1743f54de4cSJeremy Kerr { 1753f54de4cSJeremy Kerr struct log_handler *lh = to_log_handler(handler); 176f733c85aSJeremy Kerr ringbuffer_consumer_unregister(lh->rbc); 1773f54de4cSJeremy Kerr close(lh->fd); 1783f54de4cSJeremy Kerr } 1793f54de4cSJeremy Kerr 1803f54de4cSJeremy Kerr static struct log_handler log_handler = { 1813f54de4cSJeremy Kerr .handler = { 1823f54de4cSJeremy Kerr .name = "log", 1833f54de4cSJeremy Kerr .init = log_init, 1843f54de4cSJeremy Kerr .fini = log_fini, 1853f54de4cSJeremy Kerr }, 1863f54de4cSJeremy Kerr }; 1873f54de4cSJeremy Kerr 18855c9712dSJeremy Kerr console_handler_register(&log_handler.handler); 1893f54de4cSJeremy Kerr 190