The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/arm/mv/twsi.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * Copyright (C) 2008 MARVELL INTERNATIONAL LTD.
    3  * All rights reserved.
    4  *
    5  * Developed by Semihalf.
    6  *
    7  * Redistribution and use in source and binary forms, with or without
    8  * modification, are permitted provided that the following conditions
    9  * are met:
   10  * 1. Redistributions of source code must retain the above copyright
   11  *    notice, this list of conditions and the following disclaimer.
   12  * 2. Redistributions in binary form must reproduce the above copyright
   13  *    notice, this list of conditions and the following disclaimer in the
   14  *    documentation and/or other materials provided with the distribution.
   15  * 3. Neither the name of MARVELL nor the names of contributors
   16  *    may be used to endorse or promote products derived from this software
   17  *    without specific prior written permission.
   18  *
   19  * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   22  * ARE DISCLAIMED.  IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE
   23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   29  * SUCH DAMAGE.
   30  */
   31 
   32 /*
   33  * Driver for the TWSI (aka I2C, aka IIC) bus controller found on Marvell
   34  * SoCs. Supports master operation only, and works in polling mode.
   35  *
   36  * Calls to DELAY() are needed per Application Note AN-179 "TWSI Software
   37  * Guidelines for Discovery(TM), Horizon (TM) and Feroceon(TM) Devices".
   38  */
   39 
   40 #include <sys/cdefs.h>
   41 __FBSDID("$FreeBSD: releng/10.0/sys/arm/mv/twsi.c 239508 2012-08-21 17:49:20Z hrs $");
   42 
   43 #include <sys/param.h>
   44 #include <sys/systm.h>
   45 #include <sys/bus.h>
   46 #include <sys/kernel.h>
   47 #include <sys/module.h>
   48 #include <sys/resource.h>
   49 
   50 #include <machine/_inttypes.h>
   51 #include <machine/bus.h>
   52 #include <machine/resource.h>
   53 
   54 #include <sys/rman.h>
   55 
   56 #include <sys/lock.h>
   57 #include <sys/mutex.h>
   58 
   59 #include <dev/iicbus/iiconf.h>
   60 #include <dev/iicbus/iicbus.h>
   61 #include <dev/fdt/fdt_common.h>
   62 #include <dev/ofw/ofw_bus.h>
   63 #include <dev/ofw/ofw_bus_subr.h>
   64 
   65 #include <arm/mv/mvreg.h>
   66 #include <arm/mv/mvvar.h>
   67 
   68 #include "iicbus_if.h"
   69 
   70 #define MV_TWSI_NAME            "twsi"
   71 #define IICBUS_DEVNAME          "iicbus"
   72 
   73 #define TWSI_SLAVE_ADDR         0x00
   74 #define TWSI_EXT_SLAVE_ADDR     0x10
   75 #define TWSI_DATA               0x04
   76 
   77 #define TWSI_CONTROL            0x08
   78 #define TWSI_CONTROL_ACK        (1 << 2)
   79 #define TWSI_CONTROL_IFLG       (1 << 3)
   80 #define TWSI_CONTROL_STOP       (1 << 4)
   81 #define TWSI_CONTROL_START      (1 << 5)
   82 #define TWSI_CONTROL_TWSIEN     (1 << 6)
   83 #define TWSI_CONTROL_INTEN      (1 << 7)
   84 
   85 #define TWSI_STATUS                     0x0c
   86 #define TWSI_STATUS_START               0x08
   87 #define TWSI_STATUS_RPTD_START          0x10
   88 #define TWSI_STATUS_ADDR_W_ACK          0x18
   89 #define TWSI_STATUS_DATA_WR_ACK         0x28
   90 #define TWSI_STATUS_ADDR_R_ACK          0x40
   91 #define TWSI_STATUS_DATA_RD_ACK         0x50
   92 #define TWSI_STATUS_DATA_RD_NOACK       0x58
   93 
   94 #define TWSI_BAUD_RATE          0x0c
   95 #define TWSI_BAUD_RATE_PARAM(M,N)       ((((M) << 3) | ((N) & 0x7)) & 0x7f)
   96 #define TWSI_BAUD_RATE_RAW(C,M,N)       ((C)/((10*(M+1))<<(N+1)))
   97 #define TWSI_BAUD_RATE_SLOW             50000   /* 50kHz */
   98 #define TWSI_BAUD_RATE_FAST             100000  /* 100kHz */
   99 
  100 #define TWSI_SOFT_RESET         0x1c
  101 
  102 #define TWSI_DEBUG
  103 #undef TWSI_DEBUG
  104 
  105 #ifdef  TWSI_DEBUG
  106 #define debugf(fmt, args...) do { printf("%s(): ", __func__); printf(fmt,##args); } while (0)
  107 #else
  108 #define debugf(fmt, args...)
  109 #endif
  110 
  111 struct mv_twsi_softc {
  112         device_t        dev;
  113         struct resource *res[1];        /* SYS_RES_MEMORY */
  114         struct mtx      mutex;
  115         device_t        iicbus;
  116 };
  117 
  118 static struct mv_twsi_baud_rate {
  119         uint32_t        raw;
  120         int             param;
  121         int             m;
  122         int             n;
  123 } baud_rate[IIC_FASTEST + 1];
  124 
  125 static int mv_twsi_probe(device_t);
  126 static int mv_twsi_attach(device_t);
  127 static int mv_twsi_detach(device_t);
  128 
  129 static int mv_twsi_reset(device_t dev, u_char speed, u_char addr,
  130     u_char *oldaddr);
  131 static int mv_twsi_repeated_start(device_t dev, u_char slave, int timeout);
  132 static int mv_twsi_start(device_t dev, u_char slave, int timeout);
  133 static int mv_twsi_stop(device_t dev);
  134 static int mv_twsi_read(device_t dev, char *buf, int len, int *read, int last,
  135     int delay);
  136 static int mv_twsi_write(device_t dev, const char *buf, int len, int *sent,
  137     int timeout);
  138 
  139 static struct resource_spec res_spec[] = {
  140         { SYS_RES_MEMORY, 0, RF_ACTIVE },
  141         { -1, 0 }
  142 };
  143 
  144 static device_method_t mv_twsi_methods[] = {
  145         /* device interface */
  146         DEVMETHOD(device_probe,         mv_twsi_probe),
  147         DEVMETHOD(device_attach,        mv_twsi_attach),
  148         DEVMETHOD(device_detach,        mv_twsi_detach),
  149 
  150         /* iicbus interface */
  151         DEVMETHOD(iicbus_callback, iicbus_null_callback),
  152         DEVMETHOD(iicbus_repeated_start, mv_twsi_repeated_start),
  153         DEVMETHOD(iicbus_start,         mv_twsi_start),
  154         DEVMETHOD(iicbus_stop,          mv_twsi_stop),
  155         DEVMETHOD(iicbus_write,         mv_twsi_write),
  156         DEVMETHOD(iicbus_read,          mv_twsi_read),
  157         DEVMETHOD(iicbus_reset,         mv_twsi_reset),
  158         DEVMETHOD(iicbus_transfer,      iicbus_transfer_gen),
  159         { 0, 0 }
  160 };
  161 
  162 static devclass_t mv_twsi_devclass;
  163 
  164 static driver_t mv_twsi_driver = {
  165         MV_TWSI_NAME,
  166         mv_twsi_methods,
  167         sizeof(struct mv_twsi_softc),
  168 };
  169 
  170 DRIVER_MODULE(twsi, simplebus, mv_twsi_driver, mv_twsi_devclass, 0, 0);
  171 DRIVER_MODULE(iicbus, twsi, iicbus_driver, iicbus_devclass, 0, 0);
  172 MODULE_DEPEND(twsi, iicbus, 1, 1, 1);
  173 
  174 static __inline uint32_t
  175 TWSI_READ(struct mv_twsi_softc *sc, bus_size_t off)
  176 {
  177 
  178         return (bus_read_4(sc->res[0], off));
  179 }
  180 
  181 static __inline void
  182 TWSI_WRITE(struct mv_twsi_softc *sc, bus_size_t off, uint32_t val)
  183 {
  184 
  185         bus_write_4(sc->res[0], off, val);
  186 }
  187 
  188 static __inline void
  189 twsi_control_clear(struct mv_twsi_softc *sc, uint32_t mask)
  190 {
  191         uint32_t val;
  192 
  193         val = TWSI_READ(sc, TWSI_CONTROL);
  194         val &= ~mask;
  195         TWSI_WRITE(sc, TWSI_CONTROL, val);
  196 }
  197 
  198 static __inline void
  199 twsi_control_set(struct mv_twsi_softc *sc, uint32_t mask)
  200 {
  201         uint32_t val;
  202 
  203         val = TWSI_READ(sc, TWSI_CONTROL);
  204         val |= mask;
  205         TWSI_WRITE(sc, TWSI_CONTROL, val);
  206 }
  207 
  208 static __inline void
  209 twsi_clear_iflg(struct mv_twsi_softc *sc)
  210 {
  211 
  212         DELAY(1000);
  213         twsi_control_clear(sc, TWSI_CONTROL_IFLG);
  214         DELAY(1000);
  215 }
  216 
  217 
  218 /*
  219  * timeout given in us
  220  * returns
  221  *   0 on sucessfull mask change
  222  *   non-zero on timeout
  223  */
  224 static int
  225 twsi_poll_ctrl(struct mv_twsi_softc *sc, int timeout, uint32_t mask)
  226 {
  227 
  228         timeout /= 10;
  229         while (!(TWSI_READ(sc, TWSI_CONTROL) & mask)) {
  230                 DELAY(10);
  231                 if (--timeout < 0)
  232                         return (timeout);
  233         }
  234         return (0);
  235 }
  236 
  237 
  238 /*
  239  * 'timeout' is given in us. Note also that timeout handling is not exact --
  240  * twsi_locked_start() total wait can be more than 2 x timeout
  241  * (twsi_poll_ctrl() is called twice). 'mask' can be either TWSI_STATUS_START
  242  * or TWSI_STATUS_RPTD_START
  243  */
  244 static int
  245 twsi_locked_start(device_t dev, struct mv_twsi_softc *sc, int32_t mask,
  246     u_char slave, int timeout)
  247 {
  248         int read_access, iflg_set = 0;
  249         uint32_t status;
  250 
  251         mtx_assert(&sc->mutex, MA_OWNED);
  252 
  253         if (mask == TWSI_STATUS_RPTD_START)
  254                 /* read IFLG to know if it should be cleared later; from NBSD */
  255                 iflg_set = TWSI_READ(sc, TWSI_CONTROL) & TWSI_CONTROL_IFLG;
  256 
  257         twsi_control_set(sc, TWSI_CONTROL_START);
  258 
  259         if (mask == TWSI_STATUS_RPTD_START && iflg_set) {
  260                 debugf("IFLG set, clearing\n");
  261                 twsi_clear_iflg(sc);
  262         }
  263 
  264         /*
  265          * Without this delay we timeout checking IFLG if the timeout is 0.
  266          * NBSD driver always waits here too.
  267          */
  268         DELAY(1000);
  269 
  270         if (twsi_poll_ctrl(sc, timeout, TWSI_CONTROL_IFLG)) {
  271                 debugf("timeout sending %sSTART condition\n",
  272                     mask == TWSI_STATUS_START ? "" : "repeated ");
  273                 return (IIC_ETIMEOUT);
  274         }
  275 
  276         status = TWSI_READ(sc, TWSI_STATUS);
  277         if (status != mask) {
  278                 debugf("wrong status (%02x) after sending %sSTART condition\n",
  279                     status, mask == TWSI_STATUS_START ? "" : "repeated ");
  280                 return (IIC_ESTATUS);
  281         }
  282 
  283         TWSI_WRITE(sc, TWSI_DATA, slave);
  284         DELAY(1000);
  285         twsi_clear_iflg(sc);
  286 
  287         if (twsi_poll_ctrl(sc, timeout, TWSI_CONTROL_IFLG)) {
  288                 debugf("timeout sending slave address\n");
  289                 return (IIC_ETIMEOUT);
  290         }
  291         
  292         read_access = (slave & 0x1) ? 1 : 0;
  293         status = TWSI_READ(sc, TWSI_STATUS);
  294         if (status != (read_access ?
  295             TWSI_STATUS_ADDR_R_ACK : TWSI_STATUS_ADDR_W_ACK)) {
  296                 debugf("no ACK (status: %02x) after sending slave address\n",
  297                     status);
  298                 return (IIC_ENOACK);
  299         }
  300 
  301         return (IIC_NOERR);
  302 }
  303 
  304 static int
  305 mv_twsi_probe(device_t dev)
  306 {
  307 
  308         if (!ofw_bus_is_compatible(dev, "mrvl,twsi"))
  309                 return (ENXIO);
  310 
  311         device_set_desc(dev, "Marvell Integrated I2C Bus Controller");
  312         return (BUS_PROBE_DEFAULT);
  313 }
  314 
  315 #define ABSSUB(a,b)     (((a) > (b)) ? (a) - (b) : (b) - (a))
  316 static void
  317 mv_twsi_cal_baud_rate(const uint32_t target, struct mv_twsi_baud_rate *rate)
  318 {
  319         uint32_t clk, cur, diff, diff0;
  320         int m, n, m0, n0;
  321 
  322         /* Calculate baud rate. */
  323         m0 = n0 = 4;    /* Default values on reset */
  324         diff0 = 0xffffffff;
  325         clk = get_tclk();
  326 
  327         for (n = 0; n < 8; n++) {
  328                 for (m = 0; m < 16; m++) {
  329                         cur = TWSI_BAUD_RATE_RAW(clk,m,n);
  330                         diff = ABSSUB(target, cur);
  331                         if (diff < diff0) {
  332                                 m0 = m;
  333                                 n0 = n;
  334                                 diff0 = diff;
  335                         }
  336                 }
  337         }
  338         rate->raw = TWSI_BAUD_RATE_RAW(clk, m0, n0);
  339         rate->param = TWSI_BAUD_RATE_PARAM(m0, n0);
  340         rate->m = m0;
  341         rate->n = n0;
  342 }
  343 
  344 static int
  345 mv_twsi_attach(device_t dev)
  346 {
  347         struct mv_twsi_softc *sc;
  348         phandle_t child, iicbusnode;
  349         device_t childdev;
  350         struct iicbus_ivar *devi;
  351         char dname[32]; /* 32 is taken from struct u_device */
  352         uint32_t paddr;
  353         int len, error;
  354 
  355         sc = device_get_softc(dev);
  356         sc->dev = dev;
  357         bzero(baud_rate, sizeof(baud_rate));
  358 
  359         mtx_init(&sc->mutex, device_get_nameunit(dev), MV_TWSI_NAME, MTX_DEF);
  360 
  361         /* Allocate IO resources */
  362         if (bus_alloc_resources(dev, res_spec, sc->res)) {
  363                 device_printf(dev, "could not allocate resources\n");
  364                 mv_twsi_detach(dev);
  365                 return (ENXIO);
  366         }
  367 
  368         mv_twsi_cal_baud_rate(TWSI_BAUD_RATE_SLOW, &baud_rate[IIC_SLOW]);
  369         mv_twsi_cal_baud_rate(TWSI_BAUD_RATE_FAST, &baud_rate[IIC_FAST]);
  370         if (bootverbose)
  371                 device_printf(dev, "calculated baud rates are:\n"
  372                     " %" PRIu32 " kHz (M=%d, N=%d) for slow,\n"
  373                     " %" PRIu32 " kHz (M=%d, N=%d) for fast.\n",
  374                     baud_rate[IIC_SLOW].raw / 1000,
  375                     baud_rate[IIC_SLOW].m,
  376                     baud_rate[IIC_SLOW].n,
  377                     baud_rate[IIC_FAST].raw / 1000,
  378                     baud_rate[IIC_FAST].m,
  379                     baud_rate[IIC_FAST].n);
  380 
  381         sc->iicbus = device_add_child(dev, IICBUS_DEVNAME, -1);
  382         if (sc->iicbus == NULL) {
  383                 device_printf(dev, "could not add iicbus child\n");
  384                 mv_twsi_detach(dev);
  385                 return (ENXIO);
  386         }
  387         /* Attach iicbus. */
  388         bus_generic_attach(dev);
  389 
  390         iicbusnode = 0;
  391         /* Find iicbus as the child devices in the device tree. */
  392         for (child = OF_child(ofw_bus_get_node(dev)); child != 0;
  393             child = OF_peer(child)) {
  394                 len = OF_getproplen(child, "model");
  395                 if (len <= 0 || len > sizeof(dname) - 1)
  396                         continue;
  397                 error = OF_getprop(child, "model", &dname, len);
  398                 dname[len + 1] = '\0';
  399                 if (error == -1)
  400                         continue;
  401                 len = strlen(dname);
  402                 if (len == strlen(IICBUS_DEVNAME) &&
  403                     strncasecmp(dname, IICBUS_DEVNAME, len) == 0) {
  404                         iicbusnode = child;
  405                         break; 
  406                 }
  407         }
  408         if (iicbusnode == 0)
  409                 goto attach_end;
  410 
  411         /* Attach child devices onto iicbus. */
  412         for (child = OF_child(iicbusnode); child != 0; child = OF_peer(child)) {
  413                 /* Get slave address. */
  414                 error = OF_getprop(child, "i2c-address", &paddr, sizeof(paddr));
  415                 if (error == -1)
  416                         error = OF_getprop(child, "reg", &paddr, sizeof(paddr));
  417                 if (error == -1)
  418                         continue;
  419 
  420                 /* Get device driver name. */
  421                 len = OF_getproplen(child, "model");
  422                 if (len <= 0 || len > sizeof(dname) - 1)
  423                         continue;
  424                 OF_getprop(child, "model", &dname, len);
  425                 dname[len + 1] = '\0';
  426 
  427                 if (bootverbose)
  428                         device_printf(dev, "adding a device %s at %d.\n",
  429                             dname, fdt32_to_cpu(paddr));
  430                 childdev = BUS_ADD_CHILD(sc->iicbus, 0, dname, -1);
  431                 devi = IICBUS_IVAR(childdev);
  432                 devi->addr = fdt32_to_cpu(paddr);
  433         }
  434 
  435 attach_end:
  436         bus_generic_attach(sc->iicbus);
  437 
  438         return (0);
  439 }
  440 
  441 static int
  442 mv_twsi_detach(device_t dev)
  443 {
  444         struct mv_twsi_softc *sc;
  445         int rv;
  446 
  447         sc = device_get_softc(dev);
  448 
  449         if ((rv = bus_generic_detach(dev)) != 0)
  450                 return (rv);
  451 
  452         if (sc->iicbus != NULL)
  453                 if ((rv = device_delete_child(dev, sc->iicbus)) != 0)
  454                         return (rv);
  455 
  456         bus_release_resources(dev, res_spec, sc->res);
  457 
  458         mtx_destroy(&sc->mutex);
  459         return (0);
  460 }
  461 
  462 /*
  463  * Only slave mode supported, disregard [old]addr
  464  */
  465 static int
  466 mv_twsi_reset(device_t dev, u_char speed, u_char addr, u_char *oldaddr)
  467 {
  468         struct mv_twsi_softc *sc;
  469         uint32_t param;
  470 
  471         sc = device_get_softc(dev);
  472 
  473         switch (speed) {
  474         case IIC_SLOW:
  475         case IIC_FAST:
  476                 param = baud_rate[speed].param;
  477                 break;
  478         case IIC_FASTEST:
  479         case IIC_UNKNOWN:
  480         default:
  481                 param = baud_rate[IIC_FAST].param;
  482                 break;
  483         }
  484 
  485         mtx_lock(&sc->mutex);
  486         TWSI_WRITE(sc, TWSI_SOFT_RESET, 0x0);
  487         DELAY(2000);
  488         TWSI_WRITE(sc, TWSI_BAUD_RATE, param);
  489         TWSI_WRITE(sc, TWSI_CONTROL, TWSI_CONTROL_TWSIEN | TWSI_CONTROL_ACK);
  490         DELAY(1000);
  491         mtx_unlock(&sc->mutex);
  492 
  493         return (0);
  494 }
  495 
  496 /*
  497  * timeout is given in us
  498  */
  499 static int
  500 mv_twsi_repeated_start(device_t dev, u_char slave, int timeout)
  501 {
  502         struct mv_twsi_softc *sc;
  503         int rv;
  504 
  505         sc = device_get_softc(dev);
  506 
  507         mtx_lock(&sc->mutex);
  508         rv = twsi_locked_start(dev, sc, TWSI_STATUS_RPTD_START, slave,
  509             timeout);
  510         mtx_unlock(&sc->mutex);
  511 
  512         if (rv) {
  513                 mv_twsi_stop(dev);
  514                 return (rv);
  515         } else
  516                 return (IIC_NOERR);
  517 }
  518 
  519 /*
  520  * timeout is given in us
  521  */
  522 static int
  523 mv_twsi_start(device_t dev, u_char slave, int timeout)
  524 {
  525         struct mv_twsi_softc *sc;
  526         int rv;
  527 
  528         sc = device_get_softc(dev);
  529 
  530         mtx_lock(&sc->mutex);
  531         rv = twsi_locked_start(dev, sc, TWSI_STATUS_START, slave, timeout);
  532         mtx_unlock(&sc->mutex);
  533 
  534         if (rv) {
  535                 mv_twsi_stop(dev);
  536                 return (rv);
  537         } else
  538                 return (IIC_NOERR);
  539 }
  540 
  541 static int
  542 mv_twsi_stop(device_t dev)
  543 {
  544         struct mv_twsi_softc *sc;
  545 
  546         sc = device_get_softc(dev);
  547 
  548         mtx_lock(&sc->mutex);
  549         twsi_control_set(sc, TWSI_CONTROL_STOP);
  550         DELAY(1000);
  551         twsi_clear_iflg(sc);
  552         mtx_unlock(&sc->mutex);
  553 
  554         return (IIC_NOERR);
  555 }
  556 
  557 static int
  558 mv_twsi_read(device_t dev, char *buf, int len, int *read, int last, int delay)
  559 {
  560         struct mv_twsi_softc *sc;
  561         uint32_t status;
  562         int last_byte, rv;
  563 
  564         sc = device_get_softc(dev);
  565 
  566         mtx_lock(&sc->mutex);
  567         *read = 0;
  568         while (*read < len) {
  569                 /*
  570                  * Check if we are reading last byte of the last buffer,
  571                  * do not send ACK then, per I2C specs
  572                  */
  573                 last_byte = ((*read == len - 1) && last) ? 1 : 0;
  574                 if (last_byte)
  575                         twsi_control_clear(sc, TWSI_CONTROL_ACK);
  576                 else
  577                         twsi_control_set(sc, TWSI_CONTROL_ACK);
  578 
  579                 DELAY (1000);
  580                 twsi_clear_iflg(sc);
  581 
  582                 if (twsi_poll_ctrl(sc, delay, TWSI_CONTROL_IFLG)) {
  583                         debugf("timeout reading data\n");
  584                         rv = IIC_ETIMEOUT;
  585                         goto out;
  586                 }
  587 
  588                 status = TWSI_READ(sc, TWSI_STATUS);
  589                 if (status != (last_byte ?
  590                     TWSI_STATUS_DATA_RD_NOACK : TWSI_STATUS_DATA_RD_ACK)) {
  591                         debugf("wrong status (%02x) while reading\n", status);
  592                         rv = IIC_ESTATUS;
  593                         goto out;
  594                 }
  595 
  596                 *buf++ = TWSI_READ(sc, TWSI_DATA);
  597                 (*read)++;
  598         }
  599         rv = IIC_NOERR;
  600 out:
  601         mtx_unlock(&sc->mutex);
  602         return (rv);
  603 }
  604 
  605 static int
  606 mv_twsi_write(device_t dev, const char *buf, int len, int *sent, int timeout)
  607 {
  608         struct mv_twsi_softc *sc;
  609         uint32_t status;
  610         int rv;
  611 
  612         sc = device_get_softc(dev);
  613 
  614         mtx_lock(&sc->mutex);
  615         *sent = 0;
  616         while (*sent < len) {
  617                 TWSI_WRITE(sc, TWSI_DATA, *buf++);
  618 
  619                 twsi_clear_iflg(sc);
  620                 if (twsi_poll_ctrl(sc, timeout, TWSI_CONTROL_IFLG)) {
  621                         debugf("timeout writing data\n");
  622                         rv = IIC_ETIMEOUT;
  623                         goto out;
  624                 }
  625 
  626                 status = TWSI_READ(sc, TWSI_STATUS);
  627                 if (status != TWSI_STATUS_DATA_WR_ACK) {
  628                         debugf("wrong status (%02x) while writing\n", status);
  629                         rv = IIC_ESTATUS;
  630                         goto out;
  631                 }
  632                 (*sent)++;
  633         }
  634         rv = IIC_NOERR;
  635 out:
  636         mtx_unlock(&sc->mutex);
  637         return (rv);
  638 }

Cache object: 055d603ee25ab18d9e5b81c107d5fb13


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.