Subversion Repositories HelenOS

Rev

Rev 4347 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4347 Rev 4348
Line 41... Line 41...
41 
#include <mm/slab.h>
 41 
#include <mm/slab.h>
42 
#include <ddi/device.h>
 42 
#include <ddi/device.h>
43 
 
 43 
 
44 
#define LSR_DATA_READY  0x01
 44 
#define LSR_DATA_READY  0x01
45 
 
 45 
 
46 
static indev_operations_t kbrdin_ops = {
 - 
 
47 
    .poll = NULL
 - 
 
48 
};
 - 
 
49 
 
 - 
 
50 
static irq_ownership_t ns16550_claim(irq_t *irq)
 46 
static irq_ownership_t ns16550_claim(irq_t *irq)
51 
{
 47 
{
52 
    ns16550_instance_t *instance = irq->instance;
 48 
    ns16550_instance_t *instance = irq->instance;
53 
    ns16550_t *dev = instance->ns16550;
 49 
    ns16550_t *dev = instance->ns16550;
54 
   
 50 
   
Line 62... Line 58...
62 
{
 58 
{
63 
    ns16550_instance_t *instance = irq->instance;
 59 
    ns16550_instance_t *instance = irq->instance;
64 
    ns16550_t *dev = instance->ns16550;
 60 
    ns16550_t *dev = instance->ns16550;
65 
   
 61 
   
66 
    if (pio_read_8(&dev->lsr) & LSR_DATA_READY) {
 62 
    if (pio_read_8(&dev->lsr) & LSR_DATA_READY) {
67 
        uint8_t x = pio_read_8(&dev->rbr);
 63 
        uint8_t data = pio_read_8(&dev->rbr);
68 
        indev_push_character(&instance->kbrdin, x);
 64 
        indev_push_character(instance->kbrdin, data);
69 
    }
 65 
    }
70 
}
 66 
}
71 
 
 67 
 
- 
 
 68 
/**< Clear input buffer. */
- 
 
 69 
static void ns16550_clear_buffer(ns16550_t *dev)
- 
 
 70 
{
- 
 
 71 
    while ((pio_read_8(&dev->lsr) & LSR_DATA_READY))
- 
 
 72 
        (void) pio_read_8(&dev->rbr);
- 
 
 73 
}
- 
 
 74 
 
72 
/** Initialize ns16550.
 75 
/** Initialize ns16550.
73 
 *
 76 
 *
74 
 * @param dev      Addrress of the beginning of the device in I/O space.
 77 
 * @param dev      Addrress of the beginning of the device in I/O space.
75 
 * @param devno    Device number.
 78 
 * @param devno    Device number.
76 
 * @param inr      Interrupt number.
 79 
 * @param inr      Interrupt number.
77 
 * @param cir      Clear interrupt function.
 80 
 * @param cir      Clear interrupt function.
78 
 * @param cir_arg  First argument to cir.
 81 
 * @param cir_arg  First argument to cir.
79 
 *
 82 
 *
80 
 * @return Keyboard device pointer or NULL on failure.
 83 
 * @return Keyboard instance or NULL on failure.
81 
 *
 84 
 *
82 
 */
 85 
 */
83 
indev_t *ns16550_init(ns16550_t *dev, inr_t inr, cir_t cir, void *cir_arg)
 86 
ns16550_instance_t *ns16550_init(ns16550_t *dev, inr_t inr, cir_t cir, void *cir_arg)
84 
{
 87 
{
85 
    ns16550_instance_t *instance
 88 
    ns16550_instance_t *instance
86 
        = malloc(sizeof(ns16550_instance_t), FRAME_ATOMIC);
 89 
        = malloc(sizeof(ns16550_instance_t), FRAME_ATOMIC);
87 
    if (!instance)
 90 
    if (instance) {
- 
 
 91 
        instance->ns16550 = dev;
88 
        return NULL;
 92 
        instance->kbrdin = NULL;
89 
   
 93 
       
90 
    indev_initialize("ns16550", &instance->kbrdin, &kbrdin_ops);
 94 
        irq_initialize(&instance->irq);
- 
 
 95 
        instance->irq.devno = device_assign_devno();
- 
 
 96 
        instance->irq.inr = inr;
- 
 
 97 
        instance->irq.claim = ns16550_claim;
- 
 
 98 
        instance->irq.handler = ns16550_irq_handler;
- 
 
 99 
        instance->irq.instance = instance;
- 
 
 100 
        instance->irq.cir = cir;
- 
 
 101 
        instance->irq.cir_arg = cir_arg;
- 
 
 102 
    }
91 
   
 103 
   
92 
    instance->ns16550 = dev;
 104 
    return instance;
- 
 
 105 
}
- 
 
 106 
 
- 
 
 107 
void ns16550_wire(ns16550_instance_t *instance, indev_t *kbrdin)
- 
 
 108 
{
- 
 
 109 
    ASSERT(instance);
- 
 
 110 
    ASSERT(kbrdin);
93 
   
 111 
   
94 
    irq_initialize(&instance->irq);
 - 
 
95 
    instance->irq.devno = device_assign_devno();
 - 
 
96 
    instance->irq.inr = inr;
 112 
    instance->kbrdin = kbrdin;
97 
    instance->irq.claim = ns16550_claim;
 - 
 
98 
    instance->irq.handler = ns16550_irq_handler;
 - 
 
99 
    instance->irq.instance = instance;
 - 
 
100 
    instance->irq.cir = cir;
 - 
 
101 
    instance->irq.cir_arg = cir_arg;
 - 
 
102 
    irq_register(&instance->irq);
 113 
    irq_register(&instance->irq);
103 
   
 114 
   
104 
    while ((pio_read_8(&dev->lsr) & LSR_DATA_READY))
 115 
    ns16550_clear_buffer(instance->ns16550);
105 
        (void) pio_read_8(&dev->rbr);
 - 
 
106 
   
 116 
   
107 
    /* Enable interrupts */
 117 
    /* Enable interrupts */
108 
    pio_write_8(&dev->ier, IER_ERBFI);
 118 
    pio_write_8(&instance->ns16550->ier, IER_ERBFI);
109 
    pio_write_8(&dev->mcr, MCR_OUT2);
 119 
    pio_write_8(&instance->ns16550->mcr, MCR_OUT2);
110 
   
 - 
 
111 
    return &instance->kbrdin;
 - 
 
112 
}
 120 
}
113 
 
 121 
 
114 
/** @}
 122 
/** @}
115 
 */
 123 
 */