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
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
/*
* Copyright (c) 2016-2017 Chris Johns <chrisj@rtems.org>
* All rights reserved.
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.org/license/LICENSE.
*/
/*
* I2C slave for testing:
* https://github.com/oetr/FPGA-I2C-Slave
*/
#if HAVE_CONFIG_H
#include "config.h"
#endif
#include <dev/i2c/i2c.h>
#include <dev/i2c/fpga-i2c-slave.h>
typedef struct {
i2c_dev base;
uint16_t address;
size_t size;
} fpga_i2c_slave;
static ssize_t
fpga_i2c_slave_read(i2c_dev* base, void* buf, size_t n, off_t offset)
{
fpga_i2c_slave* dev = (fpga_i2c_slave*) base;
off_t avail = dev->size - offset;
uint8_t* in = buf;
size_t todo;
if (avail <= 0) {
return 0;
}
if (n > avail) {
n = (size_t) avail;
}
todo = n;
while (todo > 0) {
/*
* Limit the transfer size so that it can be stored in 8-bits. This may
* help some bus controllers.
*/
uint16_t cur = (uint16_t) (todo < 255 ? todo : 255);
i2c_msg msgs = {
.addr = dev->base.address,
.flags = I2C_M_RD,
.buf = in,
.len = cur
};
int err;
err = i2c_bus_transfer(dev->base.bus, &msgs, 1);
if (err != 0) {
return err;
}
todo -= cur;
in += cur;
}
return (ssize_t) n;
}
static ssize_t
fpga_i2c_slave_write(i2c_dev* base, const void* buf, size_t n, off_t offset)
{
fpga_i2c_slave* dev = (fpga_i2c_slave*) base;
off_t avail = dev->size - offset;
const uint8_t* out = buf;
size_t todo;
if (avail <= 0) {
return 0;
}
if (n > avail) {
n = (size_t) avail;
}
todo = n;
while (todo > 0) {
/*
* Limit the transfer size so that it can be stored in 8-bits. This may
* help some bus controllers.
*/
uint16_t cur = (uint16_t) (todo < 255 ? todo : 255);
i2c_msg msgs = {
.addr = dev->base.address,
.flags = 0,
.buf = RTEMS_DECONST(uint8_t*, out),
.len = cur
};
int err;
err = i2c_bus_transfer(dev->base.bus, &msgs, 1);
if (err != 0) {
return err;
}
todo -= cur;
out += cur;
}
return (ssize_t) n;
}
int
i2c_dev_register_fpga_i2c_slave(const char* bus_path,
const char* dev_path,
uint16_t address,
size_t size)
{
fpga_i2c_slave* dev;
dev = (fpga_i2c_slave*)
i2c_dev_alloc_and_init(sizeof(*dev), bus_path, address);
if (dev == NULL) {
return -1;
}
dev->base.read = fpga_i2c_slave_read;
dev->base.write = fpga_i2c_slave_write;
dev->size = size;
return i2c_dev_register(&dev->base, dev_path);
}
|