Changes in kernel/genarch/src/drivers/ns16550/ns16550.c [24abb85d:448e093] in mainline

File:

• kernel/genarch/src/drivers/ns16550/ns16550.c (modified) (8 diffs)

kernel/genarch/src/drivers/ns16550/ns16550.c

@@ -1 +1 @@
 /*
  * Copyright (c) 2009 Jakub Jermar
+ * Copyright (c) 2018 CZ.NIC, z.s.p.o.
  * All rights reserved.
  *
@@ -46 +47 @@
 #define LSR_TH_READY    0x20
 
+static uint8_t ns16550_reg_read(ns16550_instance_t *inst, ns16550_reg_t reg)
+{
+        return pio_read_8(&inst->ns16550[reg << inst->reg_shift]);
+}
+
+static void ns16550_reg_write(ns16550_instance_t *inst, ns16550_reg_t reg,
+    uint8_t val)
+{
+        pio_write_8(&inst->ns16550[reg << inst->reg_shift], val);
+}
+
 static irq_ownership_t ns16550_claim(irq_t *irq)
 {
         ns16550_instance_t *instance = irq->instance;
-        ns16550_t *dev = instance->ns16550;
-        
-        if (pio_read_8(&dev->lsr) & LSR_DATA_READY)
+
+        if (ns16550_reg_read(instance, NS16550_REG_LSR) & LSR_DATA_READY)
                 return IRQ_ACCEPT;
         else
@@ -60 +71 @@
 {
         ns16550_instance_t *instance = irq->instance;
-        ns16550_t *dev = instance->ns16550;
         
-        if (pio_read_8(&dev->lsr) & LSR_DATA_READY) {
-                uint8_t data = pio_read_8(&dev->rbr);
+        while (ns16550_reg_read(instance, NS16550_REG_LSR) & LSR_DATA_READY) {
+                uint8_t data = ns16550_reg_read(instance, NS16550_REG_RBR);
                 indev_push_character(instance->input, data);
         }
@@ -69 +79 @@
 
 /**< Clear input buffer. */
-static void ns16550_clear_buffer(ns16550_t *dev)
+static void ns16550_clear_buffer(ns16550_instance_t *instance)
 {
-        while ((pio_read_8(&dev->lsr) & LSR_DATA_READY))
-                (void) pio_read_8(&dev->rbr);
+        while (ns16550_reg_read(instance, NS16550_REG_LSR) & LSR_DATA_READY)
+                (void) ns16550_reg_read(instance, NS16550_REG_RBR);
 }
 
-static void ns16550_sendb(ns16550_t *dev, uint8_t byte)
+static void ns16550_sendb(ns16550_instance_t *instance, uint8_t byte)
 {
-        while (!(pio_read_8(&dev->lsr) & LSR_TH_READY))
+        while (!(ns16550_reg_read(instance, NS16550_REG_LSR) & LSR_TH_READY))
                 ;
-        pio_write_8(&dev->thr, byte);
+        ns16550_reg_write(instance, NS16550_REG_THR, byte);
 }
 
@@ -88 +98 @@
         if ((!instance->parea.mapped) || (console_override)) {
                 if (ascii_check(ch))
-                        ns16550_sendb(instance->ns16550, (uint8_t) ch);
+                        ns16550_sendb(instance, (uint8_t) ch);
                 else
-                        ns16550_sendb(instance->ns16550, U_SPECIAL);
+                        ns16550_sendb(instance, U_SPECIAL);
         }
 }
@@ -101 +111 @@
 /** Initialize ns16550.
  *
- * @param dev      Addrress of the beginning of the device in I/O space.
- * @param inr      Interrupt number.
- * @param cir      Clear interrupt function.
- * @param cir_arg  First argument to cir.
- * @param output   Where to store pointer to the output device
- *                 or NULL if the caller is not interested in
- *                 writing to the serial port.
+ * @param dev        Address of the beginning of the device in I/O space.
+ * @param reg_shift  Spacing between individual register addresses, in log2.
+ *                   The individual register location is calculated as
+ *                   `base + (register offset << reg_shift)`.
+ * @param inr        Interrupt number.
+ * @param cir        Clear interrupt function.
+ * @param cir_arg    First argument to cir.
+ * @param output     Where to store pointer to the output device
+ *                   or NULL if the caller is not interested in
+ *                   writing to the serial port.
  *
  * @return Keyboard instance or NULL on failure.
  *
  */
-ns16550_instance_t *ns16550_init(ns16550_t *dev, inr_t inr, cir_t cir,
-    void *cir_arg, outdev_t **output)
+ns16550_instance_t *ns16550_init(ioport8_t *dev, unsigned reg_shift, inr_t inr,
+    cir_t cir, void *cir_arg, outdev_t **output)
 {
         ns16550_instance_t *instance
@@ -119 +132 @@
         if (instance) {
                 instance->ns16550 = dev;
+                instance->reg_shift = reg_shift;
                 instance->input = NULL;
                 instance->output = NULL;
@@ -162 +176 @@
         irq_register(&instance->irq);
         
-        ns16550_clear_buffer(instance->ns16550);
+        ns16550_clear_buffer(instance);
         
         /* Enable interrupts */
-        pio_write_8(&instance->ns16550->ier, IER_ERBFI);
-        pio_write_8(&instance->ns16550->mcr, MCR_OUT2);
+        ns16550_reg_write(instance, NS16550_REG_IER, IER_ERBFI);
+        ns16550_reg_write(instance, NS16550_REG_MCR, MCR_OUT2);
 }