Commit fce388af authored by Wolfram Sang's avatar Wolfram Sang

i2c: mux: reg: simplify register size checking

Checking was done at three different locations, just do it once and
properly at probing time.
Signed-off-by: default avatarWolfram Sang <wsa@the-dreams.de>
Tested-by: default avatarYork Sun <yorksun@freescale.com>
parent bdbf4a29
...@@ -59,9 +59,6 @@ static int i2c_mux_reg_set(const struct regmux *mux, unsigned int chan_id) ...@@ -59,9 +59,6 @@ static int i2c_mux_reg_set(const struct regmux *mux, unsigned int chan_id)
if (!mux->data.write_only) if (!mux->data.write_only)
ioread8(mux->data.reg); ioread8(mux->data.reg);
break; break;
default:
pr_err("Invalid register size\n");
return -EINVAL;
} }
return 0; return 0;
...@@ -155,10 +152,6 @@ static int i2c_mux_reg_probe_dt(struct regmux *mux, ...@@ -155,10 +152,6 @@ static int i2c_mux_reg_probe_dt(struct regmux *mux,
/* map address from "reg" if exists */ /* map address from "reg" if exists */
if (of_address_to_resource(np, 0, &res)) { if (of_address_to_resource(np, 0, &res)) {
mux->data.reg_size = resource_size(&res); mux->data.reg_size = resource_size(&res);
if (mux->data.reg_size > 4) {
dev_err(&pdev->dev, "Invalid address size\n");
return -EINVAL;
}
mux->data.reg = devm_ioremap_resource(&pdev->dev, &res); mux->data.reg = devm_ioremap_resource(&pdev->dev, &res);
if (IS_ERR(mux->data.reg)) if (IS_ERR(mux->data.reg))
return PTR_ERR(mux->data.reg); return PTR_ERR(mux->data.reg);
...@@ -211,15 +204,17 @@ static int i2c_mux_reg_probe(struct platform_device *pdev) ...@@ -211,15 +204,17 @@ static int i2c_mux_reg_probe(struct platform_device *pdev)
"Register not set, using platform resource\n"); "Register not set, using platform resource\n");
res = platform_get_resource(pdev, IORESOURCE_MEM, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
mux->data.reg_size = resource_size(res); mux->data.reg_size = resource_size(res);
if (mux->data.reg_size > 4) {
dev_err(&pdev->dev, "Invalid resource size\n");
return -EINVAL;
}
mux->data.reg = devm_ioremap_resource(&pdev->dev, res); mux->data.reg = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(mux->data.reg)) if (IS_ERR(mux->data.reg))
return PTR_ERR(mux->data.reg); return PTR_ERR(mux->data.reg);
} }
if (mux->data.reg_size != 4 && mux->data.reg_size != 2 &&
mux->data.reg_size != 1) {
dev_err(&pdev->dev, "Invalid register size\n");
return -EINVAL;
}
mux->adap = devm_kzalloc(&pdev->dev, mux->adap = devm_kzalloc(&pdev->dev,
sizeof(*mux->adap) * mux->data.n_values, sizeof(*mux->adap) * mux->data.n_values,
GFP_KERNEL); GFP_KERNEL);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment