Changeset 75751db6 in mainline for uspace/drv/char


Ignore:
Timestamp:
2014-08-29T20:32:20Z (11 years ago)
Author:
Jiri Svoboda <jiri@…>
Branches:
lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export
Children:
af0a2c7
Parents:
312e5ff
Message:

Factor out chardev IPC from pl050, i8042, xtkbd and ps2mouse.

Location:
uspace/drv/char
Files:
7 edited

Legend:

Unmodified
Added
Removed

  • uspace/drv/char/i8042/i8042.c

    r312e5ff r75751db6  
    22 * Copyright (c) 2001-2004 Jakub Jermar
    33 * Copyright (c) 2006 Josef Cejka
    4  * Copyright (c) 2009 Jiri Svoboda
     4 * Copyright (c) 2014 Jiri Svoboda
    55 * Copyright (c) 2011 Jan Vesely
    66 * All rights reserved.
    … …  
    3939 */
    4040
     41#include <ddf/log.h>
     42#include <ddf/interrupt.h>
     43#include <ddi.h>
    4144#include <device/hw_res.h>
    42 #include <ddi.h>
    4345#include <errno.h>
    4446#include <str_error.h>
    4547#include <inttypes.h>
    46 #include <ddf/log.h>
    47 #include <ddf/interrupt.h>
     48#include <io/chardev_srv.h>
     49
    4850#include "i8042.h"
    4951
    … …  
    6466#define i8042_KBD_TRANSLATE  0x40  /* Use this to switch to XT scancodes */
    6567
    66 static void default_handler(ddf_fun_t *, ipc_callid_t, ipc_call_t *);
    67 
    68 /** Port function operations. */
    69 static ddf_dev_ops_t ops = {
    70         .default_handler = default_handler
     68static void i8042_char_conn(ipc_callid_t, ipc_call_t *, void *);
     69static int i8042_read(chardev_srv_t *, void *, size_t);
     70static int i8042_write(chardev_srv_t *, const void *, size_t);
     71
     72static chardev_ops_t i8042_chardev_ops = {
     73        .read = i8042_read,
     74        .write = i8042_write
    7175};
    7276
    … …  
    106110};
    107111
    108 /** Get i8042 soft state from device node. */
    109 static i8042_t *dev_i8042(ddf_dev_t *dev)
    110 {
    111         return ddf_dev_data_get(dev);
    112 }
    113 
    114112/** Wait until it is safe to write to the device. */
    115113static void wait_ready(i8042_t *dev)
    … …  
    131129    ddf_dev_t *dev)
    132130{
    133         i8042_t *controller = dev_i8042(dev);
     131        i8042_t *controller = ddf_dev_data_get(dev);
    134132       
    135133        const uint8_t status = IPC_GET_ARG1(*call);
    … …  
    186184        };
    187185       
     186        dev->kbd = ddf_fun_data_alloc(dev->kbd_fun, sizeof(i8042_port_t));
     187        if (dev->kbd == NULL) {
     188                rc = ENOMEM;
     189                goto error;
     190        }
     191       
     192        dev->kbd->ctl = dev;
     193        chardev_srvs_init(&dev->kbd->cds);
     194        dev->kbd->cds.ops = &i8042_chardev_ops;
     195        dev->kbd->cds.sarg = dev->kbd;
     196       
    188197        rc = ddf_fun_add_match_id(dev->kbd_fun, "char/xtkbd", 90);
    189198        if (rc != EOK)
    … …  
    196205        }
    197206       
     207        dev->aux = ddf_fun_data_alloc(dev->aux_fun, sizeof(i8042_port_t));
     208        if (dev->aux == NULL) {
     209                rc = ENOMEM;
     210                goto error;
     211        }
     212       
     213        dev->aux->ctl = dev;
     214        chardev_srvs_init(&dev->aux->cds);
     215        dev->aux->cds.ops = &i8042_chardev_ops;
     216        dev->aux->cds.sarg = dev->aux;
     217       
    198218        rc = ddf_fun_add_match_id(dev->aux_fun, "char/ps2mouse", 90);
    199219        if (rc != EOK)
    200220                goto error;
    201221       
    202         ddf_fun_set_ops(dev->kbd_fun, &ops);
    203         ddf_fun_set_ops(dev->aux_fun, &ops);
     222        ddf_fun_set_conn_handler(dev->kbd_fun, i8042_char_conn);
     223        ddf_fun_set_conn_handler(dev->aux_fun, i8042_char_conn);
    204224       
    205225        buffer_init(&dev->kbd_buffer, dev->kbd_data, BUFFER_SIZE);
    … …  
    298318}
    299319
    300 // FIXME TODO use shared instead this
    301 enum {
    302         IPC_CHAR_READ = DEV_FIRST_CUSTOM_METHOD,
    303         IPC_CHAR_WRITE,
    304 };
    305 
    306320/** Write data to i8042 port.
    307321 *
    308  * @param fun    DDF function.
    309  * @param buffer Data source.
    310  * @param size   Data size.
     322 * @param srv    Connection-specific data
     323 * @param buffer Data source
     324 * @param size   Data size
    311325 *
    312326 * @return Bytes written.
    313327 *
    314328 */
    315 static int i8042_write(ddf_fun_t *fun, char *buffer, size_t size)
    316 {
    317         i8042_t *controller = dev_i8042(ddf_fun_get_dev(fun));
    318         fibril_mutex_lock(&controller->write_guard);
     329static int i8042_write(chardev_srv_t *srv, const void *data, size_t size)
     330{
     331        i8042_port_t *port = (i8042_port_t *)srv->srvs->sarg;
     332        i8042_t *i8042 = port->ctl;
     333        const char *dp = (const char *)data;
     334       
     335        fibril_mutex_lock(&i8042->write_guard);
    319336       
    320337        for (size_t i = 0; i < size; ++i) {
    321                 if (controller->aux_fun == fun) {
    322                         wait_ready(controller);
    323                         pio_write_8(&controller->regs->status,
     338                if (port == i8042->aux) {
     339                        wait_ready(i8042);
     340                        pio_write_8(&i8042->regs->status,
    324341                            i8042_CMD_WRITE_AUX);
    325342                }
    326343               
    327                 wait_ready(controller);
    328                 pio_write_8(&controller->regs->data, buffer[i]);
    329         }
    330        
    331         fibril_mutex_unlock(&controller->write_guard);
     344                wait_ready(i8042);
     345                pio_write_8(&i8042->regs->data, dp[i]);
     346        }
     347       
     348        fibril_mutex_unlock(&i8042->write_guard);
    332349        return size;
    333350}
    … …  
    335352/** Read data from i8042 port.
    336353 *
    337  * @param fun    DDF function.
    338  * @param buffer Data place.
    339  * @param size   Data place size.
     354 * @param srv    Connection-specific data
     355 * @param buffer Data place
     356 * @param size   Data place size
    340357 *
    341358 * @return Bytes read.
    342359 *
    343360 */
    344 static int i8042_read(ddf_fun_t *fun, char *data, size_t size)
    345 {
    346         i8042_t *controller = dev_i8042(ddf_fun_get_dev(fun));
    347         buffer_t *buffer = (fun == controller->aux_fun) ?
    348             &controller->aux_buffer : &controller->kbd_buffer;
     361static int i8042_read(chardev_srv_t *srv, void *dest, size_t size)
     362{
     363        i8042_port_t *port = (i8042_port_t *)srv->srvs->sarg;
     364        i8042_t *i8042 = port->ctl;
     365        uint8_t *destp = (uint8_t *)dest;
     366       
     367        buffer_t *buffer = (port == i8042->aux) ?
     368            &i8042->aux_buffer : &i8042->kbd_buffer;
    349369       
    350370        for (size_t i = 0; i < size; ++i)
    351                 *data++ = buffer_read(buffer);
     371                *destp++ = buffer_read(buffer);
    352372       
    353373        return size;
    … …  
    356376/** Handle data requests.
    357377 *
    358  * @param fun  ddf_fun_t function.
    359378 * @param id   callid
    360379 * @param call IPC request.
    361  *
    362  */
    363 static void default_handler(ddf_fun_t *fun, ipc_callid_t id, ipc_call_t *call)
    364 {
    365         const sysarg_t method = IPC_GET_IMETHOD(*call);
    366         const size_t size = IPC_GET_ARG1(*call);
    367        
    368         switch (method) {
    369         case IPC_CHAR_READ:
    370                 if (size <= 4 * sizeof(sysarg_t)) {
    371                         sysarg_t message[4] = {};
    372                        
    373                         i8042_read(fun, (char *) message, size);
    374                         async_answer_4(id, size, message[0], message[1],
    375                             message[2], message[3]);
    376                 } else
    377                         async_answer_0(id, ELIMIT);
    378                 break;
    379        
    380         case IPC_CHAR_WRITE:
    381                 if (size <= 3 * sizeof(sysarg_t)) {
    382                         const sysarg_t message[3] = {
    383                                 IPC_GET_ARG2(*call),
    384                                 IPC_GET_ARG3(*call),
    385                                 IPC_GET_ARG4(*call)
    386                         };
    387                        
    388                         i8042_write(fun, (char *) message, size);
    389                         async_answer_0(id, size);
    390                 } else
    391                         async_answer_0(id, ELIMIT);
    392        
    393         default:
    394                 async_answer_0(id, EINVAL);
    395         }
     380 * @param arg  ddf_fun_t function.
     381 */
     382void i8042_char_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg)
     383{
     384        i8042_port_t *port = ddf_fun_data_get((ddf_fun_t *)arg);
     385
     386        chardev_conn(iid, icall, &port->cds);
    396387}
    397388

  • uspace/drv/char/i8042/i8042.h

    r312e5ff r75751db6  
    4040#define i8042_H_
    4141
     42#include <io/chardev_srv.h>
    4243#include <sys/types.h>
    4344#include <fibril_synch.h>
    … …  
    5657} __attribute__ ((packed)) i8042_regs_t;
    5758
    58 /** i8042 driver structure. */
     59/** i8042 Port. */
     60typedef struct {
     61        struct i8042 *ctl;              /**< Controller */
     62        chardev_srvs_t cds;             /**< Character device server data */
     63} i8042_port_t;
     64
     65/** i8042 Controller. */
    5966typedef struct i8042 {
    6067        i8042_regs_t *regs;             /**< I/O registers. */
    … …  
    6572        uint8_t aux_data[BUFFER_SIZE];  /**< Primary port buffer space. */
    6673        uint8_t kbd_data[BUFFER_SIZE];  /**< Aux. port buffer space. */
     74        i8042_port_t *kbd;
     75        i8042_port_t *aux;
    6776        fibril_mutex_t write_guard;     /**< Prevents simultanous port writes.*/
    6877} i8042_t;
     78
    6979
    7080extern int i8042_init(i8042_t *, addr_range_t *, int, int, ddf_dev_t *);

  • uspace/drv/char/pl050/pl050.c

    r312e5ff r75751db6  
    3838#include <ddf/log.h>
    3939#include <device/hw_res_parsed.h>
     40#include <io/chardev_srv.h>
    4041
    4142#define NAME "pl050"
    … …  
    4546
    4647#define PL050_STAT_RXFULL  (1 << 4)
    47 
    48 enum {
    49         IPC_CHAR_READ = DEV_FIRST_CUSTOM_METHOD,
    50         IPC_CHAR_WRITE,
    51 };
    5248
    5349enum {
    … …  
    5955static int pl050_fun_offline(ddf_fun_t *);
    6056static void pl050_char_conn(ipc_callid_t, ipc_call_t *, void *);
     57static int pl050_read(chardev_srv_t *, void *, size_t);
     58static int pl050_write(chardev_srv_t *, const void *, size_t);
    6159
    6260static driver_ops_t driver_ops = {
    … …  
    7169};
    7270
     71static chardev_ops_t pl050_chardev_ops = {
     72        .read = pl050_read,
     73        .write = pl050_write
     74};
     75
    7376typedef struct {
     77        async_sess_t *parent_sess;
    7478        ddf_dev_t *dev;
     79
    7580        ddf_fun_t *fun_a;
    76         async_sess_t *parent_sess;
     81        chardev_srvs_t cds;
     82
    7783        uintptr_t iobase;
    7884        size_t iosize;
    … …  
    135141        size_t nidx;
    136142
     143        ddf_msg(LVL_NOTE, "Interrupt");
     144
    137145        fibril_mutex_lock(&pl050->buf_lock);
    138146        nidx = (pl050->buf_wp + 1) % buffer_size;
    … …  
    209217}
    210218
    211 static int pl050_read(pl050_t *pl050, void *buffer, size_t size)
    212 {
     219static int pl050_read(chardev_srv_t *srv, void *buffer, size_t size)
     220{
     221        pl050_t *pl050 = (pl050_t *)srv->srvs->sarg;
    213222        uint8_t *bp = buffer;
     223        size_t left;
    214224        fibril_mutex_lock(&pl050->buf_lock);
    215225
    216         while (size > 0) {
     226        left = size;
     227        while (left > 0) {
    217228                while (pl050->buf_rp == pl050->buf_wp)
    218229                        fibril_condvar_wait(&pl050->buf_cv, &pl050->buf_lock);
    219230                *bp++ = pl050->buffer[pl050->buf_rp];
    220                 --size;
     231                --left;
    221232                pl050->buf_rp = (pl050->buf_rp + 1) % buffer_size;
    222233        }
    … …  
    224235        fibril_mutex_unlock(&pl050->buf_lock);
    225236
    226         return EOK;
    227 }
    228 
    229 static int pl050_write(pl050_t *pl050, void *data, size_t size)
    230 {
    231         return EOK;
     237        return size;
     238}
     239
     240static int pl050_write(chardev_srv_t *srv, const void *data, size_t size)
     241{
     242        return size;
    232243}
    233244
    … …  
    236247        pl050_t *pl050 = pl050_from_fun((ddf_fun_t *)arg);
    237248
    238         /* Accept the connection */
    239         async_answer_0(iid, EOK);
    240 
    241         while (true) {
    242                 ipc_call_t call;
    243                 ipc_callid_t callid = async_get_call(&call);
    244                 sysarg_t method = IPC_GET_IMETHOD(call);
    245                 size_t size = IPC_GET_ARG1(call);
    246 
    247                 if (!method) {
    248                         /* The other side has hung up */
    249                         async_answer_0(callid, EOK);
    250                         break;
    251                 }
    252 
    253                 switch (method) {
    254                 case IPC_CHAR_READ:
    255                         if (size <= 4 * sizeof(sysarg_t)) {
    256                                 sysarg_t message[4] = {};
    257 
    258                                 pl050_read(pl050, (char *) message, size);
    259                                 async_answer_4(callid, size, message[0], message[1],
    260                                     message[2], message[3]);
    261                         } else
    262                                 async_answer_0(callid, ELIMIT);
    263                         break;
    264 
    265                 case IPC_CHAR_WRITE:
    266                         if (size <= 3 * sizeof(sysarg_t)) {
    267                                 const sysarg_t message[3] = {
    268                                         IPC_GET_ARG2(call),
    269                                         IPC_GET_ARG3(call),
    270                                         IPC_GET_ARG4(call)
    271                                 };
    272 
    273                                 pl050_write(pl050, (char *) message, size);
    274                                 async_answer_0(callid, size);
    275                         } else
    276                                 async_answer_0(callid, ELIMIT);
    277 
    278                 default:
    279                         async_answer_0(callid, EINVAL);
    280                 }
    281         }
     249        chardev_conn(iid, icall, &pl050->cds);
    282250}
    283251
    … …  
    289257        int rc;
    290258
    291         ddf_msg(LVL_DEBUG, "pl050_dev_add()");
     259        ddf_msg(LVL_NOTE, "pl050_dev_add()");
    292260
    293261        pl050 = ddf_dev_data_alloc(dev, sizeof(pl050_t));
    … …  
    308276        pl050->dev = dev;
    309277
     278if (1) {
    310279        rc = pl050_init(pl050);
    311280        if (rc != EOK)
    312281                goto error;
    313 
     282}
    314283        rc = ddf_fun_add_match_id(fun_a, "char/xtkbd", 10);
    315284        if (rc != EOK) {
    … …  
    319288        }
    320289
     290        ddf_msg(LVL_NOTE, "Init srvs");
     291        if (1) {
     292        chardev_srvs_init(&pl050->cds);
     293        pl050->cds.ops = &pl050_chardev_ops;
     294        pl050->cds.sarg = pl050;
     295
    321296        ddf_fun_set_conn_handler(fun_a, pl050_char_conn);
    322 
     297}
    323298        rc = ddf_fun_bind(fun_a);
    324299        if (rc != EOK) {
    … …  
    328303        }
    329304
     305        ddf_msg(LVL_NOTE, "Device added");
    330306        ddf_msg(LVL_DEBUG, "Device added.");
    331307        return EOK;

  • uspace/drv/char/ps2mouse/Makefile

    r312e5ff r75751db6  
    3333
    3434SOURCES = \
    35         chardev.c \
    3635        main.c \
    3736        ps2mouse.c

  • uspace/drv/char/ps2mouse/ps2mouse.c

    r312e5ff r75751db6  
    3737#include <ddf/log.h>
    3838#include <io/keycode.h>
     39#include <io/chardev.h>
    3940#include <io/console.h>
    4041#include <ipc/mouseev.h>
    … …  
    4243
    4344#include "ps2mouse.h"
    44 #include "chardev.h"
    4545
    4646#define PS2_MOUSE_GET_DEVICE_ID   0xf2

  • uspace/drv/char/xtkbd/Makefile

    r312e5ff r75751db6  
    3333
    3434SOURCES = \
    35         chardev.c \
    3635        main.c \
    3736        xtkbd.c

  • uspace/drv/char/xtkbd/xtkbd.c

    r312e5ff r75751db6  
    3636#include <ddf/log.h>
    3737#include <io/keycode.h>
     38#include <io/chardev.h>
    3839#include <io/console.h>
    3940#include <ipc/kbdev.h>
    4041#include <abi/ipc/methods.h>
    4142
    42 #include "chardev.h"
    4343#include "xtkbd.h"
    4444
Note: See TracChangeset for help on using the changeset viewer.