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