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
|
/**
* @file
*
* @brief Switch NXP PCA9548A Driver Implementation
*
* @ingroup I2CSWITCHNXPPCA9548A
*/
/*
* Copyright (c) 2014 embedded brains GmbH. 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.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <dev/i2c/switch-nxp-pca9548a.h>
static int switch_nxp_pca9548a_do_get_control(
i2c_dev *dev,
uint8_t *val
)
{
i2c_msg msg = {
.addr = dev->address,
.flags = I2C_M_RD,
.len = (uint16_t) sizeof(*val),
.buf = val
};
return i2c_bus_transfer(dev->bus, &msg, 1);
}
static int switch_nxp_pca9548a_do_set_control(
i2c_dev *dev,
uint8_t val
)
{
i2c_msg msg = {
.addr = dev->address,
.flags = 0,
.len = (uint16_t) sizeof(val),
.buf = &val
};
return i2c_bus_transfer(dev->bus, &msg, 1);
}
static int switch_nxp_pca9548a_ioctl(
i2c_dev *dev,
ioctl_command_t command,
void *arg
)
{
uint8_t v8 = (uint8_t)(uintptr_t) arg;
int err;
switch (command) {
case SWITCH_NXP_PCA9548A_GET_CONTROL:
err = switch_nxp_pca9548a_do_get_control(dev, arg);
break;
case SWITCH_NXP_PCA9548A_SET_CONTROL:
err = switch_nxp_pca9548a_do_set_control(dev, v8);
break;
default:
err = -ENOTTY;
break;
}
return err;
}
int i2c_dev_register_switch_nxp_pca9548a(
const char *bus_path,
const char *dev_path,
uint16_t address
)
{
i2c_dev *dev;
dev = i2c_dev_alloc_and_init(sizeof(*dev), bus_path, address);
if (dev == NULL) {
return -1;
}
dev->ioctl = switch_nxp_pca9548a_ioctl;
return i2c_dev_register(dev, dev_path);
}
|