2 * Multiplexed I2C bus driver.
4 * Copyright (c) 2008-2009 Rodolfo Giometti <giometti@linux.it>
5 * Copyright (c) 2008-2009 Eurotech S.p.A. <info@eurotech.it>
6 * Copyright (c) 2009-2010 NSN GmbH & Co KG <michael.lawnick.ext@nsn.com>
8 * Simplifies access to complex multiplexed I2C bus topologies, by presenting
9 * each multiplexed bus segment as an additional I2C adapter.
10 * Supports multi-level mux'ing (mux behind a mux).
13 * i2c-virt.c from Kumar Gala <galak@kernel.crashing.org>
14 * i2c-virtual.c from Ken Harrenstien, Copyright (c) 2004 Google, Inc.
15 * i2c-virtual.c from Brian Kuschak <bkuschak@yahoo.com>
17 * This file is licensed under the terms of the GNU General Public
18 * License version 2. This program is licensed "as is" without any
19 * warranty of any kind, whether express or implied.
22 #include <linux/kernel.h>
23 #include <linux/module.h>
24 #include <linux/slab.h>
25 #include <linux/i2c.h>
26 #include <linux/i2c-mux.h>
28 /* multiplexer per channel data */
30 struct i2c_adapter adap
;
31 struct i2c_algorithm algo
;
33 struct i2c_adapter
*parent
;
34 void *mux_dev
; /* the mux chip/device */
35 u32 chan_id
; /* the channel id */
37 int (*select
)(struct i2c_adapter
*, void *mux_dev
, u32 chan_id
);
38 int (*deselect
)(struct i2c_adapter
*, void *mux_dev
, u32 chan_id
);
41 static int i2c_mux_master_xfer(struct i2c_adapter
*adap
,
42 struct i2c_msg msgs
[], int num
)
44 struct i2c_mux_priv
*priv
= adap
->algo_data
;
45 struct i2c_adapter
*parent
= priv
->parent
;
48 /* Switch to the right mux port and perform the transfer. */
50 ret
= priv
->select(parent
, priv
->mux_dev
, priv
->chan_id
);
52 ret
= parent
->algo
->master_xfer(parent
, msgs
, num
);
54 priv
->deselect(parent
, priv
->mux_dev
, priv
->chan_id
);
59 static int i2c_mux_smbus_xfer(struct i2c_adapter
*adap
,
60 u16 addr
, unsigned short flags
,
61 char read_write
, u8 command
,
62 int size
, union i2c_smbus_data
*data
)
64 struct i2c_mux_priv
*priv
= adap
->algo_data
;
65 struct i2c_adapter
*parent
= priv
->parent
;
68 /* Select the right mux port and perform the transfer. */
70 ret
= priv
->select(parent
, priv
->mux_dev
, priv
->chan_id
);
72 ret
= parent
->algo
->smbus_xfer(parent
, addr
, flags
,
73 read_write
, command
, size
, data
);
75 priv
->deselect(parent
, priv
->mux_dev
, priv
->chan_id
);
80 /* Return the parent's functionality */
81 static u32
i2c_mux_functionality(struct i2c_adapter
*adap
)
83 struct i2c_mux_priv
*priv
= adap
->algo_data
;
84 struct i2c_adapter
*parent
= priv
->parent
;
86 return parent
->algo
->functionality(parent
);
89 struct i2c_adapter
*i2c_add_mux_adapter(struct i2c_adapter
*parent
,
90 void *mux_dev
, u32 force_nr
, u32 chan_id
,
91 int (*select
) (struct i2c_adapter
*,
93 int (*deselect
) (struct i2c_adapter
*,
96 struct i2c_mux_priv
*priv
;
99 priv
= kzalloc(sizeof(struct i2c_mux_priv
), GFP_KERNEL
);
103 /* Set up private adapter data */
104 priv
->parent
= parent
;
105 priv
->mux_dev
= mux_dev
;
106 priv
->chan_id
= chan_id
;
107 priv
->select
= select
;
108 priv
->deselect
= deselect
;
110 /* Need to do algo dynamically because we don't know ahead
111 * of time what sort of physical adapter we'll be dealing with.
113 if (parent
->algo
->master_xfer
)
114 priv
->algo
.master_xfer
= i2c_mux_master_xfer
;
115 if (parent
->algo
->smbus_xfer
)
116 priv
->algo
.smbus_xfer
= i2c_mux_smbus_xfer
;
117 priv
->algo
.functionality
= i2c_mux_functionality
;
119 /* Now fill out new adapter structure */
120 snprintf(priv
->adap
.name
, sizeof(priv
->adap
.name
),
121 "i2c-%d-mux (chan_id %d)", i2c_adapter_id(parent
), chan_id
);
122 priv
->adap
.owner
= THIS_MODULE
;
123 priv
->adap
.algo
= &priv
->algo
;
124 priv
->adap
.algo_data
= priv
;
125 priv
->adap
.dev
.parent
= &parent
->dev
;
128 priv
->adap
.nr
= force_nr
;
129 ret
= i2c_add_numbered_adapter(&priv
->adap
);
131 ret
= i2c_add_adapter(&priv
->adap
);
134 dev_err(&parent
->dev
,
135 "failed to add mux-adapter (error=%d)\n",
141 dev_info(&parent
->dev
, "Added multiplexed i2c bus %d\n",
142 i2c_adapter_id(&priv
->adap
));
146 EXPORT_SYMBOL_GPL(i2c_add_mux_adapter
);
148 int i2c_del_mux_adapter(struct i2c_adapter
*adap
)
150 struct i2c_mux_priv
*priv
= adap
->algo_data
;
153 ret
= i2c_del_adapter(adap
);
160 EXPORT_SYMBOL_GPL(i2c_del_mux_adapter
);
162 MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>");
163 MODULE_DESCRIPTION("I2C driver for multiplexed I2C busses");
164 MODULE_LICENSE("GPL v2");
This page took 0.032794 seconds and 5 git commands to generate.