1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
|
/* Copyright 2016 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#include "common.h"
#include "link_defs.h"
#include "registers.h"
#include "i2c.h"
#include "usb_descriptor.h"
#include "util.h"
#include "common.h"
#include "console.h"
#include "consumer.h"
#include "queue.h"
#include "queue_policies.h"
#include "producer.h"
#include "task.h"
#include "usb-stream.h"
#include "usb_i2c.h"
#define CPRINTS(format, args...) cprints(CC_I2C, format, ## args)
USB_I2C_CONFIG(i2c,
USB_IFACE_I2C,
USB_STR_I2C_NAME,
USB_EP_I2C)
static int16_t usb_i2c_map_error(int error)
{
switch (error) {
case EC_SUCCESS: return USB_I2C_SUCCESS;
case EC_ERROR_TIMEOUT: return USB_I2C_TIMEOUT;
case EC_ERROR_BUSY: return USB_I2C_BUSY;
default: return USB_I2C_UNKNOWN_ERROR | (error & 0x7fff);
}
}
static uint8_t usb_i2c_read_packet(struct usb_i2c_config const *config)
{
return QUEUE_REMOVE_UNITS(config->consumer.queue, config->buffer,
queue_count(config->consumer.queue));
}
static void usb_i2c_write_packet(struct usb_i2c_config const *config,
uint8_t count)
{
QUEUE_ADD_UNITS(config->tx_queue, config->buffer, count);
}
void usb_i2c_deferred(struct usb_i2c_config const *config)
{
/*
* And if there is a USB packet waiting we process it and generate a
* response.
*/
uint8_t count = usb_i2c_read_packet(config);
int portindex = (config->buffer[0] >> 0) & 0xff;
uint8_t slave_addr = (config->buffer[0] >> 8) & 0xff;
int write_count = (config->buffer[1] >> 0) & 0xff;
int read_count = (config->buffer[1] >> 8) & 0xff;
int port;
int rv;
config->buffer[0] = 0;
config->buffer[1] = 0;
if (!count || (!read_count && !write_count))
return;
if (write_count > USB_I2C_MAX_WRITE_COUNT ||
write_count != (count - 4)) {
config->buffer[0] = USB_I2C_WRITE_COUNT_INVALID;
} else if (read_count > USB_I2C_MAX_READ_COUNT) {
config->buffer[0] = USB_I2C_READ_COUNT_INVALID;
} else if (portindex >= i2c_ports_used) {
config->buffer[0] = USB_I2C_PORT_INVALID;
} else {
rv = usb_i2c_board_enable();
if (rv) {
config->buffer[0] = usb_i2c_map_error(rv);
} else {
port = i2c_ports[portindex].port;
config->buffer[0] = usb_i2c_map_error(
i2c_xfer(port, slave_addr,
(uint8_t *)(config->buffer + 2),
write_count,
(uint8_t *)(config->buffer + 2),
read_count, I2C_XFER_SINGLE));
usb_i2c_board_disable(1);
}
}
usb_i2c_write_packet(config, read_count + 4);
}
static void usb_i2c_written(struct consumer const *consumer, size_t count)
{
struct usb_i2c_config const *config =
DOWNCAST(consumer, struct usb_i2c_config, consumer);
hook_call_deferred(config->deferred, 0);
}
static void usb_i2c_flush(struct consumer const *consumer)
{
}
struct consumer_ops const usb_i2c_consumer_ops = {
.written = usb_i2c_written,
.flush = usb_i2c_flush,
};
|