[PATCH 03/12] mfd: flexcard: add posix clock mfd-cell

[Holger Dengler]

The Flexcard offers a Flexray network synchronized counter with a
selectable resolution of 1us, 100ns or 10ns. Add an appropriate MFD-cell
to use the counter.

Signed-off-by: Benedikt Spranger <b.spranger@xxxxxxxxxxxxx>
Signed-off-by: Holger Dengler <dengler@xxxxxxxxxxxxx>
cc: Lee Jones <lee.jones@xxxxxxxxxx>
---
 drivers/mfd/flexcard_core.c | 40 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 40 insertions(+)

diff --git a/drivers/mfd/flexcard_core.c b/drivers/mfd/flexcard_core.c
index 2ee9089..73eb726 100644
--- a/drivers/mfd/flexcard_core.c
+++ b/drivers/mfd/flexcard_core.c
@@ -28,11 +28,32 @@
 
 #define FLEXCARD_CONF_START	0x000
 #define FLEXCARD_CONF_SIZE	0x13F
+#define FLEXCARD_CLKRST_START	0x144
+#define FLEXCARD_CLKRST_SIZE	0x3
 #define FLEXCARD_NF_START	0x170
 #define FLEXCARD_NF_SIZE	0x7
+#define FLEXCARD_CLK_START	0x700
+#define FLEXCARD_CLK_SIZE	0x13
 
 static DEFINE_IDA(flexcard_ida);
 
+static struct resource flexcard_clk_res[] = {
+	DEFINE_RES_MEM_NAMED(FLEXCARD_CLK_START,
+			     FLEXCARD_CLK_SIZE,
+			     "flexcard-clock"),
+	DEFINE_RES_MEM_NAMED(FLEXCARD_CLKRST_START,
+			     FLEXCARD_CLKRST_SIZE,
+			     "flexcard-clock-reset"),
+};
+
+static struct mfd_cell flexcard_clk_dev[] = {
+	{
+		.name = "flexcard-clock",
+		.num_resources = ARRAY_SIZE(flexcard_clk_res),
+		.resources = flexcard_clk_res,
+	},
+};
+
 static struct resource flexcard_misc_res[] = {
 	DEFINE_RES_MEM_NAMED(FLEXCARD_CONF_START,
 			     FLEXCARD_CONF_SIZE,
@@ -55,6 +76,19 @@ enum flexcard_cell_id {
 	FLEXCARD_CELL_FLEXRAY,
 };
 
+static int flexcard_clk_setup(struct flexcard_device *priv)
+{
+	struct pci_dev *pdev = priv->pdev;
+
+	flexcard_clk_dev[0].id = priv->cardnr;
+	flexcard_clk_res[0].parent = &pdev->resource[0];
+	flexcard_clk_res[1].parent = &pdev->resource[0];
+
+	return mfd_add_devices(&pdev->dev, 0, flexcard_clk_dev,
+			       ARRAY_SIZE(flexcard_clk_dev),
+			       &pdev->resource[0], 0, NULL);
+}
+
 static int flexcard_misc_setup(struct flexcard_device *priv)
 {
 	struct pci_dev *pdev = priv->pdev;
@@ -220,6 +254,12 @@ static int flexcard_probe(struct pci_dev *pdev,
 		goto out_mfd_dev_remove;
 	}
 
+	ret = flexcard_clk_setup(priv);
+	if (ret) {
+		dev_err(&pdev->dev, "unable to register clksrc: %d\n", ret);
+		goto out_mfd_dev_remove;
+	}
+
 	dev_info(&pdev->dev, "HW %02x.%02x.%02x FW %02x.%02x.%02x\n",
 		 hw_ver.ver.maj, hw_ver.ver.min, hw_ver.ver.dev,
 		 fw_ver.ver.maj, fw_ver.ver.min, fw_ver.ver.dev);
-- 
2.1.4