aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/i2c/i2c-mux.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/i2c/i2c-mux.c')
-rw-r--r--drivers/i2c/i2c-mux.c22
1 files changed, 22 insertions, 0 deletions
diff --git a/drivers/i2c/i2c-mux.c b/drivers/i2c/i2c-mux.c
index 1038c381aea..d94e0ce7827 100644
--- a/drivers/i2c/i2c-mux.c
+++ b/drivers/i2c/i2c-mux.c
@@ -88,9 +88,23 @@ static u32 i2c_mux_functionality(struct i2c_adapter *adap)
88 return parent->algo->functionality(parent); 88 return parent->algo->functionality(parent);
89} 89}
90 90
91/* Return all parent classes, merged */
92static unsigned int i2c_mux_parent_classes(struct i2c_adapter *parent)
93{
94 unsigned int class = 0;
95
96 do {
97 class |= parent->class;
98 parent = i2c_parent_is_i2c_adapter(parent);
99 } while (parent);
100
101 return class;
102}
103
91struct i2c_adapter *i2c_add_mux_adapter(struct i2c_adapter *parent, 104struct i2c_adapter *i2c_add_mux_adapter(struct i2c_adapter *parent,
92 struct device *mux_dev, 105 struct device *mux_dev,
93 void *mux_priv, u32 force_nr, u32 chan_id, 106 void *mux_priv, u32 force_nr, u32 chan_id,
107 unsigned int class,
94 int (*select) (struct i2c_adapter *, 108 int (*select) (struct i2c_adapter *,
95 void *, u32), 109 void *, u32),
96 int (*deselect) (struct i2c_adapter *, 110 int (*deselect) (struct i2c_adapter *,
@@ -127,6 +141,14 @@ struct i2c_adapter *i2c_add_mux_adapter(struct i2c_adapter *parent,
127 priv->adap.algo_data = priv; 141 priv->adap.algo_data = priv;
128 priv->adap.dev.parent = &parent->dev; 142 priv->adap.dev.parent = &parent->dev;
129 143
144 /* Sanity check on class */
145 if (i2c_mux_parent_classes(parent) & class)
146 dev_err(&parent->dev,
147 "Segment %d behind mux can't share classes with ancestors\n",
148 chan_id);
149 else
150 priv->adap.class = class;
151
130 /* 152 /*
131 * Try to populate the mux adapter's of_node, expands to 153 * Try to populate the mux adapter's of_node, expands to
132 * nothing if !CONFIG_OF. 154 * nothing if !CONFIG_OF.