firmware/logf.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2005 by Daniel Stenberg
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21
  22 /*
  23  * logf() logs entries in a circular buffer. Each logged string is null-terminated.
  24  *
  25  * When the length of log exceeds MAX_LOGF_SIZE bytes, the buffer wraps.
  26  *
  27  */
  28
  29 #include <string.h>
  30 #include <stdio.h>
  31 #include <stdarg.h>
  32 #include "config.h"
  33 #include "system.h"
  34 #include "font.h"
  35 #ifdef HAVE_REMOTE_LCD
  36 #include "lcd-remote.h"
  37 #endif
  38 #include "logf.h"
  39 #include "serial.h"
  40 #include "format.h"
  41
  42 #ifdef HAVE_USBSTACK
  43 #include "usb_core.h"
  44 #include "usbstack/usb_serial.h"
  45 #endif
  46
  47 /* Only provide all this if asked to */
  48 #ifdef ROCKBOX_HAS_LOGF
  49
  50 #ifndef __PCTOOL__
  51 unsigned char logfbuffer[MAX_LOGF_SIZE];
  52 int logfindex;
  53 bool logfwrap;
  54 #endif
  55
  56 #ifdef HAVE_REMOTE_LCD
  57 static void displayremote(void)
  58 {
  59     /* TODO: we should have a debug option that enables/disables this! */
  60     int w, h, i;
  61     int fontnr;
  62     int cur_x, cur_y, delta_y, delta_x;
  63     struct font* font;
  64     int nb_lines;
  65     char buf[2];
  66     /* Memorize the pointer to the beginning of the last ... lines
  67        I assume delta_y >= 6 to avoid wasting memory and allocating memory dynamically
  68        I hope there is no font with height < 6 ! */
  69     const int NB_ENTRIES=LCD_REMOTE_HEIGHT / 6;
  70     int line_start_ptr[NB_ENTRIES];
  71
  72     fontnr = lcd_getfont();
  73     font = font_get(fontnr);
  74
  75     /* get the horizontal size of each line */
  76     font_getstringsize("A", NULL, &delta_y, fontnr);
  77
  78     /* font too small ? */
  79     if(delta_y < 6)
  80         return;
  81     /* nothing to print ? */
  82     if(logfindex == 0 && !logfwrap)
  83         return;
  84
  85     w = LCD_REMOTE_WIDTH;
  86     h = LCD_REMOTE_HEIGHT;
  87     nb_lines = 0;
  88
  89     if(logfwrap)
  90         i = logfindex;
  91     else
  92         i = 0;
  93
  94     cur_x = 0;
  95
  96     line_start_ptr[0] = i;
  97
  98     do
  99     {
 100         if(logfbuffer[i] == '\0')
 101         {
 102             line_start_ptr[++nb_lines % NB_ENTRIES] = i+1;
 103             cur_x = 0;
 104         }
 105         else
 106         {
 107             /* does character fit on this line ? */
 108             delta_x = font_get_width(font, logfbuffer[i]);
 109
 110             if(cur_x + delta_x > w)
 111             {
 112                 cur_x = 0;
 113                 line_start_ptr[++nb_lines % NB_ENTRIES] = i;
 114             }
 115             /* update pointer */
 116             cur_x += delta_x;
 117         }
 118         i++;
 119         if(i >= MAX_LOGF_SIZE)
 120             i = 0;
 121     } while(i != logfindex);
 122
 123     lcd_remote_clear_display();
 124
 125     i = line_start_ptr[ MAX(nb_lines - h / delta_y, 0) % NB_ENTRIES];
 126     cur_x = 0;
 127     cur_y = 0;
 128     buf[1] = '\0';
 129
 130     do {
 131         if(logfbuffer[i] == '\0')
 132         {
 133             cur_y += delta_y;
 134             cur_x = 0;
 135         }
 136         else
 137         {
 138             /* does character fit on this line ? */
 139             delta_x = font_get_width(font, logfbuffer[i]);
 140
 141             if(cur_x + delta_x > w)
 142             {
 143                 cur_y += delta_y;
 144                 cur_x = 0;
 145             }
 146
 147             buf[0] = logfbuffer[i];
 148             lcd_remote_putsxy(cur_x, cur_y, buf);
 149             cur_x += delta_x;
 150         }
 151
 152         i++;
 153         if(i >= MAX_LOGF_SIZE)
 154             i = 0;
 155     } while(i != logfindex);
 156
 157     lcd_remote_update();
 158 }
 159 #else
 160 #define displayremote()
 161 #endif
 162
 163 #ifdef __PCTOOL__
 164 void _logf(const char *format, ...)
 165 {
 166     char buf[1024];
 167     va_list ap;
 168     va_start(ap, format);
 169
 170     vsnprintf(buf, sizeof buf, format, ap);
 171     printf("DEBUG: %s\n", buf);
 172 }
 173 #else
 174 static void check_logfindex(void)
 175 {
 176     if(logfindex >= MAX_LOGF_SIZE)
 177     {
 178         /* wrap */
 179         logfwrap = true;
 180         logfindex = 0;
 181     }
 182 }
 183
 184 static int logf_push(void *userp, unsigned char c)
 185 {
 186     (void)userp;
 187
 188     logfbuffer[logfindex++] = c;
 189     check_logfindex();
 190
 191 #if defined(HAVE_SERIAL) && !defined(SIMULATOR)
 192     if(c != '\0')
 193     {
 194         char buf[2];
 195         buf[0] = c;
 196         buf[1] = '\0';
 197         serial_tx(buf);
 198     }
 199 #endif
 200
 201     return true;
 202 }
 203
 204 void _logf(const char *fmt, ...)
 205 {
 206     #ifdef USB_ENABLE_SERIAL
 207     int old_logfindex = logfindex;
 208     #endif
 209     va_list ap;
 210
 211     va_start(ap, fmt);
 212
 213 #if (CONFIG_PLATFORM & PLATFORM_HOSTED)
 214     char buf[1024];
 215     vsnprintf(buf, sizeof buf, fmt, ap);
 216     DEBUGF("%s\n", buf);
 217     /* restart va_list otherwise the result if undefined when vuprintf is called */
 218     va_end(ap);
 219     va_start(ap, fmt);
 220 #endif
 221
 222     vuprintf(logf_push, NULL, fmt, ap);
 223     va_end(ap);
 224
 225     /* add trailing zero */
 226     logf_push(NULL, '\0');
 227
 228 #if defined(HAVE_SERIAL) && !defined(SIMULATOR)
 229     serial_tx("\r\n");
 230 #endif
 231 #ifdef USB_ENABLE_SERIAL
 232
 233     if(logfindex < old_logfindex)
 234     {
 235         usb_serial_send(logfbuffer + old_logfindex, MAX_LOGF_SIZE - old_logfindex);
 236         usb_serial_send(logfbuffer, logfindex - 1);
 237     }
 238     else
 239         usb_serial_send(logfbuffer + old_logfindex, logfindex - old_logfindex - 1);
 240     usb_serial_send("\r\n", 2);
 241 #endif
 242
 243     displayremote();
 244 }
 245 #endif
 246
 247 #endif