diff --git a/hypervisor/debug/logmsg.c b/hypervisor/debug/logmsg.c index b96ed27b3..827652101 100644 --- a/hypervisor/debug/logmsg.c +++ b/hypervisor/debug/logmsg.c @@ -41,7 +41,14 @@ */ #define LOG_MESSAGE_MAX_SIZE (4 * LOG_ENTRY_SIZE) +/* buf size should be identical to the size in hvlog option, which is + * transfered to SOS: + * bsp/uefi/clearlinux/acrn.conf: hvlog=2M@0x1FE00000 + */ +#define HVLOG_BUF_SIZE (2*1024*1024) + DEFINE_CPU_DATA(char [LOG_MESSAGE_MAX_SIZE], logbuf); +DEFINE_CPU_DATA(struct shared_buf *, earlylog_sbuf); struct logmsg { uint32_t flags; @@ -51,10 +58,63 @@ struct logmsg { static struct logmsg logmsg; +static inline void alloc_earlylog_sbuf(uint32_t cpu_id) +{ + uint32_t ele_size = LOG_ENTRY_SIZE; + uint32_t ele_num = ((HVLOG_BUF_SIZE >> 1) / phy_cpu_num + - SBUF_HEAD_SIZE) / ele_size; + + per_cpu(earlylog_sbuf, cpu_id) = sbuf_allocate(ele_num, ele_size); + if (!per_cpu(earlylog_sbuf,cpu_id)) + printf("failed to allcate sbuf for hvlog - %d\n", cpu_id); +} + +static inline void free_earlylog_sbuf(uint32_t cpu_id) +{ + if (!per_cpu(earlylog_sbuf, cpu_id)) + return; + + free(per_cpu(earlylog_sbuf, cpu_id)); + per_cpu(earlylog_sbuf, cpu_id) = NULL; +} + +static int do_copy_earlylog(struct shared_buf *dst_sbuf, + struct shared_buf *src_sbuf) +{ + uint32_t buf_size, valid_size; + uint32_t cur_tail; + spinlock_rflags; + + if (src_sbuf->ele_size != dst_sbuf->ele_size + && src_sbuf->ele_num != dst_sbuf->ele_num) { + spinlock_irqsave_obtain(&(logmsg.lock)); + printf("Error to copy early hvlog: size mismatch\n"); + spinlock_irqrestore_release(&(logmsg.lock)); + return -EINVAL; + } + + cur_tail = src_sbuf->tail; + buf_size = SBUF_HEAD_SIZE + dst_sbuf->size; + valid_size = SBUF_HEAD_SIZE + cur_tail; + + memcpy_s((void *)dst_sbuf, buf_size, (void *)src_sbuf, valid_size); + if (dst_sbuf->tail != cur_tail) + /* there is chance to lose new log from certain pcpu */ + dst_sbuf->tail = cur_tail; + + return 0; +} + void init_logmsg(__unused uint32_t mem_size, uint32_t flags) { + int32_t idx; + logmsg.flags = flags; logmsg.seq = 0; + + /* allocate sbuf for log before sos booting */ + for (idx = 0; idx < phy_cpu_num; idx++) + alloc_earlylog_sbuf(idx); } void do_logmsg(uint32_t severity, const char *fmt, ...) @@ -114,6 +174,18 @@ void do_logmsg(uint32_t severity, const char *fmt, ...) int i, msg_len; struct shared_buf *sbuf = (struct shared_buf *) per_cpu(sbuf, cpu_id)[ACRN_HVLOG]; + struct shared_buf *early_sbuf = per_cpu(earlylog_sbuf, cpu_id); + + if (early_sbuf) { + if (sbuf) { + /* switch to sbuf from sos */ + do_copy_earlylog(sbuf, early_sbuf); + free_earlylog_sbuf(cpu_id); + } else + /* use earlylog sbuf if no sbuf from sos */ + sbuf = early_sbuf; + } + if (sbuf != NULL) { msg_len = strnlen_s(buffer, LOG_MESSAGE_MAX_SIZE); @@ -131,31 +203,43 @@ void print_logmsg_buffer(uint32_t cpu_id) spinlock_rflags; char buffer[LOG_ENTRY_SIZE + 1]; int read_cnt; - struct shared_buf *sbuf; + struct shared_buf **sbuf; + int is_earlylog = 0; if (cpu_id >= (uint32_t)phy_cpu_num) return; - sbuf = (struct shared_buf *)per_cpu(sbuf, cpu_id)[ACRN_HVLOG]; - if (sbuf != NULL) { + if (per_cpu(earlylog_sbuf, cpu_id)) { + sbuf = &per_cpu(earlylog_sbuf, cpu_id); + is_earlylog = 1; + } else + sbuf = (struct shared_buf **) + &per_cpu(sbuf, cpu_id)[ACRN_HVLOG]; + + spinlock_irqsave_obtain(&(logmsg.lock)); + if (*sbuf) + printf("CPU%d: head: 0x%x, tail: 0x%x %s\n\r", + cpu_id, (*sbuf)->head, (*sbuf)->tail, + is_earlylog ? "[earlylog]" : ""); + spinlock_irqrestore_release(&(logmsg.lock)); + + do { + uint32_t idx; + memset(buffer, 0, LOG_ENTRY_SIZE + 1); + + if (*sbuf == NULL) + return; + + read_cnt = sbuf_get(*sbuf, (uint8_t *)buffer); + + if (read_cnt <= 0) + return; + + idx = (read_cnt < LOG_ENTRY_SIZE) ? read_cnt : LOG_ENTRY_SIZE; + buffer[idx] = '\0'; + spinlock_irqsave_obtain(&(logmsg.lock)); - printf("CPU%d: head: 0x%x, tail: 0x%x\n\r", - cpu_id, sbuf->head, sbuf->tail); + printf("%s\n\r", buffer); spinlock_irqrestore_release(&(logmsg.lock)); - do { - memset(buffer, 0, LOG_ENTRY_SIZE + 1); - read_cnt = sbuf_get(sbuf, (uint8_t *)buffer); - if (read_cnt > 0) { - uint32_t idx; - - idx = (read_cnt < LOG_ENTRY_SIZE) ? - read_cnt : LOG_ENTRY_SIZE; - buffer[idx] = '\0'; - - spinlock_irqsave_obtain(&(logmsg.lock)); - printf("%s\n\r", buffer); - spinlock_irqrestore_release(&(logmsg.lock)); - } - } while (read_cnt > 0); - } + } while (read_cnt > 0); }