tests/libi2c-omap.c

   1 /*
   2  * QTest I2C driver
   3  *
   4  * Copyright (c) 2012 Andreas Färber
   5  *
   6  * This work is licensed under the terms of the GNU GPL, version 2 or later.
   7  * See the COPYING file in the top-level directory.
   8  */
   9 #include "libi2c.h"
  10
  11 #include <glib.h>
  12 #include <string.h>
  13
  14 #include "qemu/osdep.h"
  15 #include "libqtest.h"
  16
  17 enum OMAPI2CRegisters {
  18     OMAP_I2C_REV  = 0x00,
  19     OMAP_I2C_STAT = 0x08,
  20     OMAP_I2C_CNT  = 0x18,
  21     OMAP_I2C_DATA = 0x1c,
  22     OMAP_I2C_CON  = 0x24,
  23     OMAP_I2C_SA   = 0x2c,
  24 };
  25
  26 enum OMAPI2CSTATBits {
  27     OMAP_I2C_STAT_NACK = 1 << 1,
  28     OMAP_I2C_STAT_ARDY = 1 << 2,
  29     OMAP_I2C_STAT_RRDY = 1 << 3,
  30     OMAP_I2C_STAT_XRDY = 1 << 4,
  31     OMAP_I2C_STAT_ROVR = 1 << 11,
  32     OMAP_I2C_STAT_SBD  = 1 << 15,
  33 };
  34
  35 enum OMAPI2CCONBits {
  36     OMAP_I2C_CON_STT    = 1 << 0,
  37     OMAP_I2C_CON_STP    = 1 << 1,
  38     OMAP_I2C_CON_TRX    = 1 << 9,
  39     OMAP_I2C_CON_MST    = 1 << 10,
  40     OMAP_I2C_CON_BE     = 1 << 14,
  41     OMAP_I2C_CON_I2C_EN = 1 << 15,
  42 };
  43
  44 typedef struct OMAPI2C {
  45     I2CAdapter parent;
  46
  47     uint64_t addr;
  48 } OMAPI2C;
  49
  50
  51 static void omap_i2c_set_slave_addr(OMAPI2C *s, uint8_t addr)
  52 {
  53     uint16_t data = addr;
  54
  55     memwrite(s->addr + OMAP_I2C_SA, &data, 2);
  56     memread(s->addr + OMAP_I2C_SA, &data, 2);
  57     g_assert_cmphex(data, ==, addr);
  58 }
  59
  60 static void omap_i2c_send(I2CAdapter *i2c, uint8_t addr,
  61                           const uint8_t *buf, uint16_t len)
  62 {
  63     OMAPI2C *s = (OMAPI2C *)i2c;
  64     uint16_t data;
  65
  66     omap_i2c_set_slave_addr(s, addr);
  67
  68     data = len;
  69     memwrite(s->addr + OMAP_I2C_CNT, &data, 2);
  70
  71     data = OMAP_I2C_CON_I2C_EN |
  72            OMAP_I2C_CON_TRX |
  73            OMAP_I2C_CON_MST |
  74            OMAP_I2C_CON_STT |
  75            OMAP_I2C_CON_STP;
  76     memwrite(s->addr + OMAP_I2C_CON, &data, 2);
  77     memread(s->addr + OMAP_I2C_CON, &data, 2);
  78     g_assert((data & OMAP_I2C_CON_STP) != 0);
  79
  80     memread(s->addr + OMAP_I2C_STAT, &data, 2);
  81     g_assert((data & OMAP_I2C_STAT_NACK) == 0);
  82
  83     while (len > 1) {
  84         memread(s->addr + OMAP_I2C_STAT, &data, 2);
  85         g_assert((data & OMAP_I2C_STAT_XRDY) != 0);
  86
  87         memwrite(s->addr + OMAP_I2C_DATA, buf, 2);
  88         buf = (uint8_t *)buf + 2;
  89         len -= 2;
  90     }
  91     if (len == 1) {
  92         memread(s->addr + OMAP_I2C_STAT, &data, 2);
  93         g_assert((data & OMAP_I2C_STAT_XRDY) != 0);
  94
  95         memwrite(s->addr + OMAP_I2C_DATA, buf, 1);
  96     }
  97
  98     memread(s->addr + OMAP_I2C_CON, &data, 2);
  99     g_assert((data & OMAP_I2C_CON_STP) == 0);
 100 }
 101
 102 static void omap_i2c_recv(I2CAdapter *i2c, uint8_t addr,
 103                           uint8_t *buf, uint16_t len)
 104 {
 105     OMAPI2C *s = (OMAPI2C *)i2c;
 106     uint16_t data, stat;
 107
 108     omap_i2c_set_slave_addr(s, addr);
 109
 110     data = len;
 111     memwrite(s->addr + OMAP_I2C_CNT, &data, 2);
 112
 113     data = OMAP_I2C_CON_I2C_EN |
 114            OMAP_I2C_CON_MST |
 115            OMAP_I2C_CON_STT |
 116            OMAP_I2C_CON_STP;
 117     memwrite(s->addr + OMAP_I2C_CON, &data, 2);
 118     memread(s->addr + OMAP_I2C_CON, &data, 2);
 119     g_assert((data & OMAP_I2C_CON_STP) == 0);
 120
 121     memread(s->addr + OMAP_I2C_STAT, &data, 2);
 122     g_assert((data & OMAP_I2C_STAT_NACK) == 0);
 123
 124     memread(s->addr + OMAP_I2C_CNT, &data, 2);
 125     g_assert_cmpuint(data, ==, len);
 126
 127     while (len > 0) {
 128         memread(s->addr + OMAP_I2C_STAT, &data, 2);
 129         g_assert((data & OMAP_I2C_STAT_RRDY) != 0);
 130         g_assert((data & OMAP_I2C_STAT_ROVR) == 0);
 131
 132         memread(s->addr + OMAP_I2C_DATA, &data, 2);
 133
 134         memread(s->addr + OMAP_I2C_STAT, &stat, 2);
 135         if (unlikely(len == 1)) {
 136             *buf = data & 0xf;
 137             buf++;
 138             len--;
 139         } else {
 140             memcpy(buf, &data, 2);
 141             buf += 2;
 142             len -= 2;
 143         }
 144     }
 145
 146     memread(s->addr + OMAP_I2C_CON, &data, 2);
 147     g_assert((data & OMAP_I2C_CON_STP) == 0);
 148 }
 149
 150 I2CAdapter *omap_i2c_create(uint64_t addr)
 151 {
 152     OMAPI2C *s = g_malloc0(sizeof(*s));
 153     I2CAdapter *i2c = (I2CAdapter *)s;
 154     uint16_t data;
 155
 156     s->addr = addr;
 157
 158     i2c->send = omap_i2c_send;
 159     i2c->recv = omap_i2c_recv;
 160
 161     /* verify the mmio address by looking for a known signature */
 162     memread(addr + OMAP_I2C_REV, &data, 2);
 163     g_assert_cmphex(data, ==, 0x34);
 164
 165     return i2c;
 166 }