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
|
/*
* This file is part of the flashrom project.
*
* Copyright (C) 2020 The Chromium OS Authors
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <errno.h>
#include <stdio.h>
#include <string.h>
#include <sys/fcntl.h>
#include <sys/ioctl.h>
#include <unistd.h>
#include <stdlib.h>
#include <linux/i2c.h>
#include <linux/i2c-dev.h>
#include "flash.h"
#include "i2c_helper.h"
#define I2C_DEV_PREFIX "/dev/i2c-"
#define I2C_MAX_BUS 255
int i2c_close(int fd)
{
return fd == -1 ? 0 : close(fd);
}
int i2c_open(int bus, uint16_t addr, int force)
{
int ret = -1;
int fd = -1;
/* Maximum i2c bus number is 255(3 char), +1 for null terminated string. */
int path_len = strlen(I2C_DEV_PREFIX) + 4;
int request = force ? I2C_SLAVE_FORCE : I2C_SLAVE;
if (bus < 0 || bus > I2C_MAX_BUS) {
msg_perr("Invalid I2C bus %d.\n", bus);
return ret;
}
char *dev = calloc(1, path_len);
if (!dev) {
msg_perr("Unable to allocate space for device name of len %d: %s.\n",
path_len, strerror(errno));
goto linux_i2c_open_err;
}
ret = snprintf(dev, path_len, "%s%d", I2C_DEV_PREFIX, bus);
if (ret < 0) {
msg_perr("Unable to join bus number to device name: %s.\n", strerror(errno));
goto linux_i2c_open_err;
}
fd = open(dev, O_RDWR);
if (fd < 0) {
msg_perr("Unable to open I2C device %s: %s.\n", dev, strerror(errno));
ret = fd;
goto linux_i2c_open_err;
}
ret = ioctl(fd, request, addr);
if (ret < 0) {
msg_perr("Unable to set I2C slave address to 0x%02x: %s.\n", addr, strerror(errno));
i2c_close(fd);
goto linux_i2c_open_err;
}
linux_i2c_open_err:
if (dev)
free(dev);
return ret ? ret : fd;
}
int i2c_read(int fd, uint16_t addr, i2c_buffer_t *buf)
{
if (buf->len == 0)
return 0;
int ret = ioctl(fd, I2C_SLAVE, addr);
if (ret < 0) {
msg_perr("Unable to set I2C slave address to 0x%02x: %s.\n", addr, strerror(errno));
return ret;
}
return read(fd, buf->buf, buf->len);
}
int i2c_write(int fd, uint16_t addr, const i2c_buffer_t *buf)
{
if (buf->len == 0)
return 0;
int ret = ioctl(fd, I2C_SLAVE, addr);
if (ret < 0) {
msg_perr("Unable to set I2C slave address to 0x%02x: %s.\n", addr, strerror(errno));
return ret;
}
return write(fd, buf->buf, buf->len);
}
|
