]>
git.proxmox.com Git - qemu.git/blob - hw/smbus.c
2 * QEMU SMBus device emulation.
4 * Copyright (c) 2007 CodeSourcery.
5 * Written by Paul Brook
7 * This code is licenced under the LGPL.
10 /* TODO: Implement PEC. */
14 //#define DEBUG_SMBUS 1
17 #define DPRINTF(fmt, args...) \
18 do { printf("smbus(%02x): " fmt , dev->i2c.address, ##args); } while (0)
19 #define BADF(fmt, args...) \
20 do { fprintf(stderr, "smbus: error: " fmt , ##args); exit(1);} while (0)
22 #define DPRINTF(fmt, args...) do {} while(0)
23 #define BADF(fmt, args...) \
24 do { fprintf(stderr, "smbus: error: " fmt , ##args);} while (0)
36 static void smbus_do_quick_cmd(SMBusDevice
*dev
, int recv
)
38 DPRINTF("Quick Command %d\n", recv
);
40 dev
->quick_cmd(dev
, recv
);
43 static void smbus_do_write(SMBusDevice
*dev
)
45 if (dev
->data_len
== 0) {
46 smbus_do_quick_cmd(dev
, 0);
47 } else if (dev
->data_len
== 1) {
48 DPRINTF("Send Byte\n");
50 dev
->send_byte(dev
, dev
->data_buf
[0]);
53 dev
->command
= dev
->data_buf
[0];
54 DPRINTF("Command %d len %d\n", dev
->command
, dev
->data_len
- 1);
55 if (dev
->write_data
) {
56 dev
->write_data(dev
, dev
->command
, dev
->data_buf
+ 1,
62 void smbus_i2c_event(i2c_slave
*s
, enum i2c_event event
)
64 SMBusDevice
*dev
= (SMBusDevice
*)s
;
69 DPRINTF("Incoming data\n");
70 dev
->mode
= SMBUS_WRITE_DATA
;
73 BADF("Unexpected send start condition in state %d\n", dev
->mode
);
74 dev
->mode
= SMBUS_CONFUSED
;
82 DPRINTF("Read mode\n");
83 dev
->mode
= SMBUS_RECV_BYTE
;
85 case SMBUS_WRITE_DATA
:
86 if (dev
->data_len
== 0) {
87 BADF("Read after write with no data\n");
88 dev
->mode
= SMBUS_CONFUSED
;
90 if (dev
->data_len
> 1) {
93 dev
->command
= dev
->data_buf
[0];
94 DPRINTF("%02x: Command %d\n", dev
->i2c
.address
,
97 DPRINTF("Read mode\n");
99 dev
->mode
= SMBUS_READ_DATA
;
103 BADF("Unexpected recv start condition in state %d\n", dev
->mode
);
104 dev
->mode
= SMBUS_CONFUSED
;
111 case SMBUS_WRITE_DATA
:
114 case SMBUS_RECV_BYTE
:
115 smbus_do_quick_cmd(dev
, 1);
117 case SMBUS_READ_DATA
:
118 BADF("Unexpected stop during receive\n");
124 dev
->mode
= SMBUS_IDLE
;
133 case SMBUS_READ_DATA
:
134 dev
->mode
= SMBUS_DONE
;
137 BADF("Unexpected NACK in state %d\n", dev
->mode
);
138 dev
->mode
= SMBUS_CONFUSED
;
144 static int smbus_i2c_recv(i2c_slave
*s
)
146 SMBusDevice
*dev
= (SMBusDevice
*)s
;
150 case SMBUS_RECV_BYTE
:
151 if (dev
->receive_byte
) {
152 ret
= dev
->receive_byte(dev
);
156 DPRINTF("Receive Byte %02x\n", ret
);
157 dev
->mode
= SMBUS_DONE
;
159 case SMBUS_READ_DATA
:
160 if (dev
->read_data
) {
161 ret
= dev
->read_data(dev
, dev
->command
, dev
->data_len
);
166 DPRINTF("Read data %02x\n", ret
);
169 BADF("Unexpected read in state %d\n", dev
->mode
);
170 dev
->mode
= SMBUS_CONFUSED
;
177 static int smbus_i2c_send(i2c_slave
*s
, uint8_t data
)
179 SMBusDevice
*dev
= (SMBusDevice
*)s
;
181 case SMBUS_WRITE_DATA
:
182 DPRINTF("Write data %02x\n", data
);
183 dev
->data_buf
[dev
->data_len
++] = data
;
186 BADF("Unexpected write in state %d\n", dev
->mode
);
192 SMBusDevice
*smbus_device_init(i2c_bus
*bus
, int address
, int size
)
196 dev
= (SMBusDevice
*)i2c_slave_init(bus
, address
, size
);
197 dev
->i2c
.event
= smbus_i2c_event
;
198 dev
->i2c
.recv
= smbus_i2c_recv
;
199 dev
->i2c
.send
= smbus_i2c_send
;
204 /* Master device commands. */
205 void smbus_quick_command(i2c_bus
*bus
, int addr
, int read
)
207 i2c_start_transfer(bus
, addr
, read
);
208 i2c_end_transfer(bus
);
211 uint8_t smbus_receive_byte(i2c_bus
*bus
, int addr
)
215 i2c_start_transfer(bus
, addr
, 1);
216 data
= i2c_recv(bus
);
218 i2c_end_transfer(bus
);
222 void smbus_send_byte(i2c_bus
*bus
, int addr
, uint8_t data
)
224 i2c_start_transfer(bus
, addr
, 0);
226 i2c_end_transfer(bus
);
229 uint8_t smbus_read_byte(i2c_bus
*bus
, int addr
, uint8_t command
)
232 i2c_start_transfer(bus
, addr
, 0);
233 i2c_send(bus
, command
);
234 i2c_start_transfer(bus
, addr
, 1);
235 data
= i2c_recv(bus
);
237 i2c_end_transfer(bus
);
241 void smbus_write_byte(i2c_bus
*bus
, int addr
, uint8_t command
, uint8_t data
)
243 i2c_start_transfer(bus
, addr
, 0);
244 i2c_send(bus
, command
);
246 i2c_end_transfer(bus
);
249 uint16_t smbus_read_word(i2c_bus
*bus
, int addr
, uint8_t command
)
252 i2c_start_transfer(bus
, addr
, 0);
253 i2c_send(bus
, command
);
254 i2c_start_transfer(bus
, addr
, 1);
255 data
= i2c_recv(bus
);
256 data
|= i2c_recv(bus
) << 8;
258 i2c_end_transfer(bus
);
262 void smbus_write_word(i2c_bus
*bus
, int addr
, uint8_t command
, uint16_t data
)
264 i2c_start_transfer(bus
, addr
, 0);
265 i2c_send(bus
, command
);
266 i2c_send(bus
, data
& 0xff);
267 i2c_send(bus
, data
>> 8);
268 i2c_end_transfer(bus
);
271 int smbus_read_block(i2c_bus
*bus
, int addr
, uint8_t command
, uint8_t *data
)
276 i2c_start_transfer(bus
, addr
, 0);
277 i2c_send(bus
, command
);
278 i2c_start_transfer(bus
, addr
, 1);
282 for (i
= 0; i
< len
; i
++)
283 data
[i
] = i2c_recv(bus
);
285 i2c_end_transfer(bus
);
289 void smbus_write_block(i2c_bus
*bus
, int addr
, uint8_t command
, uint8_t *data
,
297 i2c_start_transfer(bus
, addr
, 0);
298 i2c_send(bus
, command
);
300 for (i
= 0; i
< len
; i
++)
301 i2c_send(bus
, data
[i
]);
302 i2c_end_transfer(bus
);