diff options
Diffstat (limited to 'drivers/i2c/i2c-mux.c')
-rw-r--r-- | drivers/i2c/i2c-mux.c | 22 |
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 */ | ||
92 | static 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 | |||
91 | struct i2c_adapter *i2c_add_mux_adapter(struct i2c_adapter *parent, | 104 | struct 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. |