arch/all-pc/boot/grub2-aros/grub-core/term/ieee1275/serial.c

   1 /*
   2  *  GRUB  --  GRand Unified Bootloader
   3  *  Copyright (C) 2000,2001,2002,2003,2004,2005,2006,2007,2008,2009,2010,2012  Free Software Foundation, Inc.
   4  *
   5  *  GRUB is free software: you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation, either version 3 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  GRUB is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #include <grub/serial.h>
  20 #include <grub/types.h>
  21 #include <grub/dl.h>
  22 #include <grub/misc.h>
  23 #include <grub/mm.h>
  24 #include <grub/time.h>
  25 #include <grub/i18n.h>
  26 #include <grub/ieee1275/console.h>
  27
  28 #define IEEE1275_IHANDLE_INVALID  ((grub_ieee1275_cell_t) 0)
  29
  30 struct ofserial_hash_ent
  31 {
  32   char *devpath;
  33   /* Pointer to shortest available name on nodes representing canonical names,
  34      otherwise NULL.  */
  35   const char *shortest;
  36   struct ofserial_hash_ent *next;
  37 };
  38
  39 static void
  40 do_real_config (struct grub_serial_port *port)
  41 {
  42   if (port->configured)
  43     return;
  44
  45   if (grub_ieee1275_open (port->elem->devpath, &port->handle)
  46       || port->handle == (grub_ieee1275_ihandle_t) -1)
  47     port->handle = IEEE1275_IHANDLE_INVALID;
  48
  49   port->configured = 1;
  50 }
  51
  52 /* Fetch a key.  */
  53 static int
  54 serial_hw_fetch (struct grub_serial_port *port)
  55 {
  56   grub_ssize_t actual;
  57   char c;
  58
  59   do_real_config (port);
  60
  61   if (port->handle == IEEE1275_IHANDLE_INVALID)
  62     return -1;
  63   grub_ieee1275_read (port->handle, &c, 1, &actual);
  64
  65   if (actual <= 0)
  66     return -1;
  67   return c;
  68 }
  69
  70 /* Put a character.  */
  71 static void
  72 serial_hw_put (struct grub_serial_port *port, const int c)
  73 {
  74   grub_ssize_t actual;
  75   char c0 = c;
  76
  77   do_real_config (port);
  78
  79   if (port->handle == IEEE1275_IHANDLE_INVALID)
  80     return;
  81
  82   grub_ieee1275_write (port->handle, &c0, 1, &actual);
  83 }
  84
  85 /* Initialize a serial device. PORT is the port number for a serial device.
  86    SPEED is a DTE-DTE speed which must be one of these: 2400, 4800, 9600,
  87    19200, 38400, 57600 and 115200. WORD_LEN is the word length to be used
  88    for the device. Likewise, PARITY is the type of the parity and
  89    STOP_BIT_LEN is the length of the stop bit. The possible values for
  90    WORD_LEN, PARITY and STOP_BIT_LEN are defined in the header file as
  91    macros.  */
  92 static grub_err_t
  93 serial_hw_configure (struct grub_serial_port *port __attribute__ ((unused)),
  94                      struct grub_serial_config *config __attribute__ ((unused)))
  95 {
  96   /*  FIXME: no IEEE1275 serial config available.  */
  97
  98   return GRUB_ERR_NONE;
  99 }
 100
 101 struct grub_serial_driver grub_ofserial_driver =
 102   {
 103     .configure = serial_hw_configure,
 104     .fetch = serial_hw_fetch,
 105     .put = serial_hw_put
 106   };
 107
 108 #define OFSERIAL_HASH_SZ        8
 109 static struct ofserial_hash_ent *ofserial_hash[OFSERIAL_HASH_SZ];
 110
 111 static int
 112 ofserial_hash_fn (const char *devpath)
 113 {
 114   int hash = 0;
 115   while (*devpath)
 116     hash ^= *devpath++;
 117   return (hash & (OFSERIAL_HASH_SZ - 1));
 118 }
 119
 120 static struct ofserial_hash_ent *
 121 ofserial_hash_find (const char *devpath)
 122 {
 123   struct ofserial_hash_ent *p = ofserial_hash[ofserial_hash_fn(devpath)];
 124
 125   while (p)
 126     {
 127       if (!grub_strcmp (p->devpath, devpath))
 128         break;
 129       p = p->next;
 130     }
 131   return p;
 132 }
 133
 134 static struct ofserial_hash_ent *
 135 ofserial_hash_add_real (char *devpath)
 136 {
 137   struct ofserial_hash_ent *p;
 138   struct ofserial_hash_ent **head = &ofserial_hash[ofserial_hash_fn(devpath)];
 139
 140   p = grub_malloc(sizeof (*p));
 141   if (!p)
 142     return NULL;
 143
 144   p->devpath = devpath;
 145   p->next = *head;
 146   p->shortest = 0;
 147   *head = p;
 148   return p;
 149 }
 150
 151 static struct ofserial_hash_ent *
 152 ofserial_hash_add (char *devpath, char *curcan)
 153 {
 154   struct ofserial_hash_ent *p, *pcan;
 155
 156   p = ofserial_hash_add_real (devpath);
 157
 158   grub_dprintf ("serial", "devpath = %s, canonical = %s\n", devpath, curcan);
 159
 160   if (!curcan)
 161     {
 162       p->shortest = devpath;
 163       return p;
 164     }
 165
 166   pcan = ofserial_hash_find (curcan);
 167   if (!pcan)
 168     pcan = ofserial_hash_add_real (curcan);
 169   else
 170     grub_free (curcan);
 171
 172   if (!pcan)
 173     grub_errno = GRUB_ERR_NONE;
 174   else
 175     {
 176       if (!pcan->shortest
 177           || grub_strlen (pcan->shortest) > grub_strlen (devpath))
 178         pcan->shortest = devpath;
 179     }
 180
 181   return p;
 182 }
 183
 184 static void
 185 dev_iterate_real (struct grub_ieee1275_devalias *alias,
 186                   int use_name)
 187 {
 188   struct ofserial_hash_ent *op;
 189
 190   if (grub_strcmp (alias->type, "serial") != 0)
 191     return;
 192
 193   grub_dprintf ("serial", "serial name = %s, path = %s\n", alias->name,
 194                 alias->path);
 195
 196   op = ofserial_hash_find (alias->path);
 197   if (!op)
 198     {
 199       char *name = grub_strdup (use_name ? alias->name : alias->path);
 200       char *can = grub_strdup (alias->path);
 201       if (!name || !can)
 202         {
 203           grub_errno = GRUB_ERR_NONE;
 204           grub_free (name);
 205           grub_free (can);
 206           return;
 207         }
 208       op = ofserial_hash_add (name, can);
 209     }
 210   return;
 211 }
 212
 213 static int
 214 dev_iterate (struct grub_ieee1275_devalias *alias)
 215 {
 216   dev_iterate_real (alias, 0);
 217   return 0;
 218 }
 219
 220 static const char *
 221 add_port (struct ofserial_hash_ent *ent)
 222 {
 223   struct grub_serial_port *port;
 224   char *ptr;
 225   grub_err_t err;
 226
 227   if (!ent->shortest)
 228     return NULL;
 229
 230   port = grub_zalloc (sizeof (*port));
 231   if (!port)
 232     return NULL;
 233   port->name = grub_malloc (sizeof ("ieee1275/")
 234                             + grub_strlen (ent->shortest));
 235   port->elem = ent;
 236   if (!port->name)
 237     return NULL;
 238   ptr = grub_stpcpy (port->name, "ieee1275/");
 239   grub_strcpy (ptr, ent->shortest);
 240
 241   port->driver = &grub_ofserial_driver;
 242   err = grub_serial_config_defaults (port);
 243   if (err)
 244     grub_print_error ();
 245
 246   grub_serial_register (port);
 247
 248   return port->name;
 249 }
 250
 251 const char *
 252 grub_ofserial_add_port (const char *path)
 253 {
 254   struct ofserial_hash_ent *ent;
 255   char *name = grub_strdup (path);
 256   char *can = grub_strdup (path);
 257
 258   if (!name || ! can)
 259     {
 260       grub_free (name);
 261       grub_free (can);
 262       return NULL;
 263     }
 264
 265   ent = ofserial_hash_add (name, can);
 266   return add_port (ent);
 267 }
 268
 269 void
 270 grub_ofserial_init (void)
 271 {
 272   unsigned i;
 273   struct grub_ieee1275_devalias alias;
 274
 275   FOR_IEEE1275_DEVALIASES(alias)
 276     dev_iterate_real (&alias, 1);
 277
 278   grub_ieee1275_devices_iterate (dev_iterate);
 279
 280   for (i = 0; i < ARRAY_SIZE (ofserial_hash); i++)
 281     {
 282       struct ofserial_hash_ent *ent;
 283       for (ent = ofserial_hash[i]; ent; ent = ent->next)
 284         add_port (ent);
 285     }
 286 }
 287