From: Stefan Binding <sbinding@opensource.cirrus.com>
To: Mark Brown <broonie@kernel.org>,
"Rafael J . Wysocki" <rafael@kernel.org>,
Len Brown <lenb@kernel.org>, Hans de Goede <hdegoede@redhat.com>,
Mark Gross <markgross@kernel.org>,
Jaroslav Kysela <perex@perex.cz>, Takashi Iwai <tiwai@suse.com>
Cc: <alsa-devel@alsa-project.org>, <linux-kernel@vger.kernel.org>,
<linux-spi@vger.kernel.org>, <linux-acpi@vger.kernel.org>,
<platform-driver-x86@vger.kernel.org>,
<patches@opensource.cirrus.com>,
Lucas Tanure <tanureal@opensource.cirrus.com>,
Stefan Binding <sbinding@opensource.cirrus.com>
Subject: [PATCH v5 6/9] platform/x86: serial-multi-instantiate: Reorganize I2C functions
Date: Fri, 21 Jan 2022 14:32:51 +0000 [thread overview]
Message-ID: <20220121143254.6432-7-sbinding@opensource.cirrus.com> (raw)
In-Reply-To: <20220121143254.6432-1-sbinding@opensource.cirrus.com>
From: Lucas Tanure <tanureal@opensource.cirrus.com>
Reorganize I2C functions to accommodate SPI support
Split the probe and factor out parts of the code
that will be used in the SPI support
Signed-off-by: Lucas Tanure <tanureal@opensource.cirrus.com>
Signed-off-by: Stefan Binding <sbinding@opensource.cirrus.com>
---
.../platform/x86/serial-multi-instantiate.c | 145 +++++++++++-------
1 file changed, 90 insertions(+), 55 deletions(-)
diff --git a/drivers/platform/x86/serial-multi-instantiate.c b/drivers/platform/x86/serial-multi-instantiate.c
index 32fb3f904547..162ec20a861a 100644
--- a/drivers/platform/x86/serial-multi-instantiate.c
+++ b/drivers/platform/x86/serial-multi-instantiate.c
@@ -29,96 +29,131 @@ struct smi_instance {
struct smi {
int i2c_num;
- struct i2c_client *i2c_devs[];
+ struct i2c_client **i2c_devs;
};
-static int smi_probe(struct platform_device *pdev)
+static int smi_get_irq(struct platform_device *pdev, struct acpi_device *adev,
+ const struct smi_instance *inst)
+{
+ int ret;
+
+ switch (inst->flags & IRQ_RESOURCE_TYPE) {
+ case IRQ_RESOURCE_GPIO:
+ ret = acpi_dev_gpio_irq_get(adev, inst->irq_idx);
+ break;
+ case IRQ_RESOURCE_APIC:
+ ret = platform_get_irq(pdev, inst->irq_idx);
+ break;
+ default:
+ ret = 0;
+ break;
+ }
+
+ if (ret < 0)
+ dev_err_probe(&pdev->dev, ret, "Error requesting irq at index %d: %d\n",
+ inst->irq_idx, ret);
+
+ return ret;
+}
+
+static void smi_devs_unregister(struct smi *smi)
+{
+ while (smi->i2c_num > 0)
+ i2c_unregister_device(smi->i2c_devs[--smi->i2c_num]);
+}
+
+/**
+ * smi_i2c_probe - Instantiate multiple I2C devices from inst array
+ * @pdev: Platform device
+ * @adev: ACPI device
+ * @smi: Internal struct for Serial multi instantiate driver
+ * @inst: Array of instances to probe
+ *
+ * Returns the number of I2C devices instantiate, Zero if none is found or a negative error code.
+ */
+static int smi_i2c_probe(struct platform_device *pdev, struct acpi_device *adev, struct smi *smi,
+ const struct smi_instance *inst_array)
{
struct i2c_board_info board_info = {};
- const struct smi_instance *inst;
struct device *dev = &pdev->dev;
- struct acpi_device *adev;
- struct smi *smi;
char name[32];
- int i, ret;
+ int i, ret, count;
- inst = device_get_match_data(dev);
- if (!inst) {
- dev_err(dev, "Error ACPI match data is missing\n");
- return -ENODEV;
- }
-
- adev = ACPI_COMPANION(dev);
-
- /* Count number of clients to instantiate */
ret = i2c_acpi_client_count(adev);
- if (ret < 0)
- return ret;
+ if (ret <= 0)
+ return ret == 0 ? -ENODEV : ret;
- smi = devm_kmalloc(dev, struct_size(smi, i2c_devs, ret), GFP_KERNEL);
- if (!smi)
- return -ENOMEM;
+ count = ret;
- smi->i2c_num = ret;
+ smi->i2c_devs = devm_kcalloc(dev, count, sizeof(*smi->i2c_devs), GFP_KERNEL);
+ if (!smi->i2c_devs)
+ return -ENOMEM;
- for (i = 0; i < smi->i2c_num && inst[i].type; i++) {
+ for (i = 0; i < count && inst_array[i].type; i++) {
memset(&board_info, 0, sizeof(board_info));
- strlcpy(board_info.type, inst[i].type, I2C_NAME_SIZE);
- snprintf(name, sizeof(name), "%s-%s.%d", dev_name(dev), inst[i].type, i);
+ strscpy(board_info.type, inst_array[i].type, I2C_NAME_SIZE);
+ snprintf(name, sizeof(name), "%s-%s.%d", dev_name(dev), inst_array[i].type, i);
board_info.dev_name = name;
- switch (inst[i].flags & IRQ_RESOURCE_TYPE) {
- case IRQ_RESOURCE_GPIO:
- ret = acpi_dev_gpio_irq_get(adev, inst[i].irq_idx);
- if (ret < 0) {
- dev_err(dev, "Error requesting irq at index %d: %d\n",
- inst[i].irq_idx, ret);
- goto error;
- }
- board_info.irq = ret;
- break;
- case IRQ_RESOURCE_APIC:
- ret = platform_get_irq(pdev, inst[i].irq_idx);
- if (ret < 0) {
- dev_dbg(dev, "Error requesting irq at index %d: %d\n",
- inst[i].irq_idx, ret);
- goto error;
- }
- board_info.irq = ret;
- break;
- default:
- board_info.irq = 0;
- break;
- }
+
+ ret = smi_get_irq(pdev, adev, &inst_array[i]);
+ if (ret < 0)
+ goto error;
+ board_info.irq = ret;
+
smi->i2c_devs[i] = i2c_acpi_new_device(dev, i, &board_info);
if (IS_ERR(smi->i2c_devs[i])) {
ret = dev_err_probe(dev, PTR_ERR(smi->i2c_devs[i]),
"Error creating i2c-client, idx %d\n", i);
goto error;
}
+ smi->i2c_num++;
}
- if (i < smi->i2c_num) {
+ if (smi->i2c_num < count) {
dev_err(dev, "Error finding driver, idx %d\n", i);
ret = -ENODEV;
goto error;
}
- platform_set_drvdata(pdev, smi);
- return 0;
+ dev_info(dev, "Instantiated %d I2C devices.\n", smi->i2c_num);
+ return 0;
error:
- while (--i >= 0)
- i2c_unregister_device(smi->i2c_devs[i]);
+ smi_devs_unregister(smi);
return ret;
}
+static int smi_probe(struct platform_device *pdev)
+{
+ const struct smi_instance *inst_array;
+ struct device *dev = &pdev->dev;
+ struct acpi_device *adev;
+ struct smi *smi;
+
+ inst_array = device_get_match_data(dev);
+ if (!inst_array) {
+ dev_err(dev, "Error ACPI match data is missing\n");
+ return -ENODEV;
+ }
+
+ adev = ACPI_COMPANION(dev);
+ if (!adev)
+ return -ENODEV;
+
+ smi = devm_kzalloc(dev, sizeof(*smi), GFP_KERNEL);
+ if (!smi)
+ return -ENOMEM;
+
+ platform_set_drvdata(pdev, smi);
+
+ return smi_i2c_probe(pdev, adev, smi, inst_array);
+}
+
static int smi_remove(struct platform_device *pdev)
{
struct smi *smi = platform_get_drvdata(pdev);
- int i;
- for (i = 0; i < smi->i2c_num; i++)
- i2c_unregister_device(smi->i2c_devs[i]);
+ smi_devs_unregister(smi);
return 0;
}
--
2.25.1
next prev parent reply other threads:[~2022-01-21 14:33 UTC|newest]
Thread overview: 18+ messages / expand[flat|nested] mbox.gz Atom feed top
2022-01-21 14:32 [PATCH v5 0/9] Support Spi in i2c-multi-instantiate driver Stefan Binding
2022-01-21 14:32 ` [PATCH v5 1/9] spi: Make spi_alloc_device and spi_add_device public again Stefan Binding
2022-01-21 14:32 ` [PATCH v5 2/9] spi: Create helper API to lookup ACPI info for spi device Stefan Binding
2022-01-21 14:32 ` [PATCH v5 3/9] spi: Support selection of the index of the ACPI Spi Resource before alloc Stefan Binding
2022-01-21 14:32 ` [PATCH v5 4/9] spi: Add API to count spi acpi resources Stefan Binding
2022-01-21 14:32 ` [PATCH v5 5/9] platform/x86: i2c-multi-instantiate: Rename it for a generic serial driver name Stefan Binding
2022-01-21 15:12 ` Rafael J. Wysocki
2022-01-21 14:32 ` Stefan Binding [this message]
2022-01-21 15:27 ` [PATCH v5 6/9] platform/x86: serial-multi-instantiate: Reorganize I2C functions Rafael J. Wysocki
2022-01-21 14:32 ` [PATCH v5 7/9] platform/x86: serial-multi-instantiate: Add SPI support Stefan Binding
2022-01-21 15:31 ` Rafael J. Wysocki
2022-01-21 16:55 ` Stefan Binding
2022-01-21 17:14 ` Rafael J. Wysocki
2022-01-26 15:19 ` Stefan Binding
2022-01-21 14:32 ` [PATCH v5 8/9] ALSA: hda/realtek: Add support for HP Laptops Stefan Binding
2022-01-21 14:44 ` Takashi Iwai
2022-01-21 14:32 ` [PATCH v5 9/9] ACPI / scan: Create platform device for CS35L41 Stefan Binding
2022-01-21 16:02 ` Rafael J. Wysocki
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20220121143254.6432-7-sbinding@opensource.cirrus.com \
--to=sbinding@opensource.cirrus.com \
--cc=alsa-devel@alsa-project.org \
--cc=broonie@kernel.org \
--cc=hdegoede@redhat.com \
--cc=lenb@kernel.org \
--cc=linux-acpi@vger.kernel.org \
--cc=linux-kernel@vger.kernel.org \
--cc=linux-spi@vger.kernel.org \
--cc=markgross@kernel.org \
--cc=patches@opensource.cirrus.com \
--cc=perex@perex.cz \
--cc=platform-driver-x86@vger.kernel.org \
--cc=rafael@kernel.org \
--cc=tanureal@opensource.cirrus.com \
--cc=tiwai@suse.com \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).