cachepc-qemu

Fork of AMDESE/qemu with changes for cachepc side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-qemu
Log | Files | Refs | Submodules | LICENSE | sfeed.txt

i2c.c (1991B)

      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 "qemu/osdep.h"
     10#include "i2c.h"
     11#include "libqtest.h"
     12
     13void qi2c_send(QI2CDevice *i2cdev, const uint8_t *buf, uint16_t len)
     14{
     15    i2cdev->bus->send(i2cdev->bus, i2cdev->addr, buf, len);
     16}
     17
     18void qi2c_recv(QI2CDevice *i2cdev, uint8_t *buf, uint16_t len)
     19{
     20    i2cdev->bus->recv(i2cdev->bus, i2cdev->addr, buf, len);
     21}
     22
     23void i2c_read_block(QI2CDevice *i2cdev, uint8_t reg,
     24                    uint8_t *buf, uint16_t len)
     25{
     26    qi2c_send(i2cdev, &reg, 1);
     27    qi2c_recv(i2cdev, buf, len);
     28}
     29
     30void i2c_write_block(QI2CDevice *i2cdev, uint8_t reg,
     31                     const uint8_t *buf, uint16_t len)
     32{
     33    uint8_t *cmd = g_malloc(len + 1);
     34    cmd[0] = reg;
     35    memcpy(&cmd[1], buf, len);
     36    qi2c_send(i2cdev, cmd, len + 1);
     37    g_free(cmd);
     38}
     39
     40uint8_t i2c_get8(QI2CDevice *i2cdev, uint8_t reg)
     41{
     42    uint8_t resp[1];
     43    i2c_read_block(i2cdev, reg, resp, sizeof(resp));
     44    return resp[0];
     45}
     46
     47uint16_t i2c_get16(QI2CDevice *i2cdev, uint8_t reg)
     48{
     49    uint8_t resp[2];
     50    i2c_read_block(i2cdev, reg, resp, sizeof(resp));
     51    return (resp[0] << 8) | resp[1];
     52}
     53
     54void i2c_set8(QI2CDevice *i2cdev, uint8_t reg, uint8_t value)
     55{
     56    i2c_write_block(i2cdev, reg, &value, 1);
     57}
     58
     59void i2c_set16(QI2CDevice *i2cdev, uint8_t reg, uint16_t value)
     60{
     61    uint8_t data[2];
     62
     63    data[0] = value >> 8;
     64    data[1] = value & 255;
     65    i2c_write_block(i2cdev, reg, data, sizeof(data));
     66}
     67
     68void *i2c_device_create(void *i2c_bus, QGuestAllocator *alloc, void *addr)
     69{
     70    QI2CDevice *i2cdev = g_new0(QI2CDevice, 1);
     71
     72    i2cdev->bus = i2c_bus;
     73    if (addr) {
     74        i2cdev->addr = ((QI2CAddress *)addr)->addr;
     75    }
     76    return &i2cdev->obj;
     77}
     78
     79void add_qi2c_address(QOSGraphEdgeOptions *opts, QI2CAddress *addr)
     80{
     81    g_assert(addr);
     82
     83    opts->arg = addr;
     84    opts->size_arg = sizeof(QI2CAddress);
     85}