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
|
// Commands for sending messages on an I2C bus
//
// Copyright (C) 2018 Florian Heilmann <Florian.Heilmann@gmx.net>
//
// This file may be distributed under the terms of the GNU GPLv3 license.
#include <string.h> // memcpy
#include "autoconf.h" // CONFIG_WANT_SOFTWARE_I2C
#include "basecmd.h" //oid_alloc
#include "command.h" //sendf
#include "sched.h" //DECL_COMMAND
#include "board/gpio.h" //i2c_write/read/setup
#include "i2c_software.h" // i2c_software_setup
#include "i2ccmds.h"
enum {
IF_SOFTWARE = 1, IF_HARDWARE = 2
};
void
command_config_i2c(uint32_t *args)
{
struct i2cdev_s *i2c = oid_alloc(args[0], command_config_i2c
, sizeof(*i2c));
}
DECL_COMMAND(command_config_i2c, "config_i2c oid=%c");
struct i2cdev_s *
i2cdev_oid_lookup(uint8_t oid)
{
return oid_lookup(oid, command_config_i2c);
}
void
command_i2c_set_bus(uint32_t *args)
{
uint8_t addr = args[3] & 0x7f;
struct i2cdev_s *i2c = i2cdev_oid_lookup(args[0]);
i2c->i2c_hw = i2c_setup(args[1], args[2], addr);
i2c->flags |= IF_HARDWARE;
}
DECL_COMMAND(command_i2c_set_bus,
"i2c_set_bus oid=%c i2c_bus=%u rate=%u address=%u");
void
i2cdev_set_software_bus(struct i2cdev_s *i2c, struct i2c_software *is)
{
i2c->i2c_sw = is;
i2c->flags |= IF_SOFTWARE;
}
void i2c_shutdown_on_err(int ret)
{
switch (ret) {
case I2C_BUS_NACK:
shutdown("I2C NACK");
case I2C_BUS_START_NACK:
shutdown("I2C START NACK");
case I2C_BUS_START_READ_NACK:
shutdown("I2C START READ NACK");
case I2C_BUS_TIMEOUT:
shutdown("I2C Timeout");
}
}
int i2c_dev_write(struct i2cdev_s *i2c, uint8_t write_len, uint8_t *data)
{
uint_fast8_t flags = i2c->flags;
if (CONFIG_WANT_SOFTWARE_I2C && flags & IF_SOFTWARE)
return i2c_software_write(i2c->i2c_sw, write_len, data);
else
return i2c_write(i2c->i2c_hw, write_len, data);
}
void command_i2c_write(uint32_t *args)
{
uint8_t oid = args[0];
struct i2cdev_s *i2c = oid_lookup(oid, command_config_i2c);
uint8_t data_len = args[1];
uint8_t *data = command_decode_ptr(args[2]);
int ret = i2c_dev_write(i2c, data_len, data);
i2c_shutdown_on_err(ret);
}
DECL_COMMAND(command_i2c_write, "i2c_write oid=%c data=%*s");
int i2c_dev_read(struct i2cdev_s *i2c, uint8_t reg_len, uint8_t *reg
, uint8_t read_len, uint8_t *read)
{
uint_fast8_t flags = i2c->flags;
if (CONFIG_WANT_SOFTWARE_I2C && flags & IF_SOFTWARE)
return i2c_software_read(i2c->i2c_sw, reg_len, reg, read_len, read);
else
return i2c_read(i2c->i2c_hw, reg_len, reg, read_len, read);
}
void command_i2c_read(uint32_t *args)
{
uint8_t oid = args[0];
struct i2cdev_s *i2c = oid_lookup(oid, command_config_i2c);
uint8_t reg_len = args[1];
uint8_t *reg = command_decode_ptr(args[2]);
uint8_t data_len = args[3];
uint8_t data[data_len];
int ret = i2c_dev_read(i2c, reg_len, reg, data_len, data);
i2c_shutdown_on_err(ret);
sendf("i2c_read_response oid=%c response=%*s", oid, data_len, data);
}
DECL_COMMAND(command_i2c_read, "i2c_read oid=%c reg=%*s read_len=%u");
|
