|
@@ -23,11 +23,14 @@
|
|
|
#include <linux/of_address.h>
|
|
|
#include <linux/of_platform.h>
|
|
|
#include <linux/slab.h>
|
|
|
+#include <linux/iopoll.h>
|
|
|
|
|
|
#include <linux/platform_data/ti-sysc.h>
|
|
|
|
|
|
#include <dt-bindings/bus/ti-sysc.h>
|
|
|
|
|
|
+#define MAX_MODULE_SOFTRESET_WAIT 10000
|
|
|
+
|
|
|
static const char * const reg_names[] = { "rev", "sysc", "syss", };
|
|
|
|
|
|
enum sysc_clocks {
|
|
@@ -88,6 +91,11 @@ struct sysc {
|
|
|
struct delayed_work idle_work;
|
|
|
};
|
|
|
|
|
|
+void sysc_write(struct sysc *ddata, int offset, u32 value)
|
|
|
+{
|
|
|
+ writel_relaxed(value, ddata->module_va + offset);
|
|
|
+}
|
|
|
+
|
|
|
static u32 sysc_read(struct sysc *ddata, int offset)
|
|
|
{
|
|
|
if (ddata->cfg.quirks & SYSC_QUIRK_16BIT) {
|
|
@@ -169,9 +177,9 @@ static int sysc_get_clocks(struct sysc *ddata)
|
|
|
const char *name;
|
|
|
int nr_fck = 0, nr_ick = 0, i, error = 0;
|
|
|
|
|
|
- ddata->clock_roles = devm_kzalloc(ddata->dev,
|
|
|
- sizeof(*ddata->clock_roles) *
|
|
|
+ ddata->clock_roles = devm_kcalloc(ddata->dev,
|
|
|
SYSC_MAX_CLOCKS,
|
|
|
+ sizeof(*ddata->clock_roles),
|
|
|
GFP_KERNEL);
|
|
|
if (!ddata->clock_roles)
|
|
|
return -ENOMEM;
|
|
@@ -200,8 +208,8 @@ static int sysc_get_clocks(struct sysc *ddata)
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
- ddata->clocks = devm_kzalloc(ddata->dev,
|
|
|
- sizeof(*ddata->clocks) * ddata->nr_clocks,
|
|
|
+ ddata->clocks = devm_kcalloc(ddata->dev,
|
|
|
+ ddata->nr_clocks, sizeof(*ddata->clocks),
|
|
|
GFP_KERNEL);
|
|
|
if (!ddata->clocks)
|
|
|
return -ENOMEM;
|
|
@@ -943,6 +951,36 @@ static void sysc_init_revision_quirks(struct sysc *ddata)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+static int sysc_reset(struct sysc *ddata)
|
|
|
+{
|
|
|
+ int offset = ddata->offsets[SYSC_SYSCONFIG];
|
|
|
+ int val;
|
|
|
+
|
|
|
+ if (ddata->legacy_mode || offset < 0 ||
|
|
|
+ ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Currently only support reset status in sysstatus.
|
|
|
+ * Warn and return error in all other cases
|
|
|
+ */
|
|
|
+ if (!ddata->cfg.syss_mask) {
|
|
|
+ dev_err(ddata->dev, "No ti,syss-mask. Reset failed\n");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ val = sysc_read(ddata, offset);
|
|
|
+ val |= (0x1 << ddata->cap->regbits->srst_shift);
|
|
|
+ sysc_write(ddata, offset, val);
|
|
|
+
|
|
|
+ /* Poll on reset status */
|
|
|
+ offset = ddata->offsets[SYSC_SYSSTATUS];
|
|
|
+
|
|
|
+ return readl_poll_timeout(ddata->module_va + offset, val,
|
|
|
+ (val & ddata->cfg.syss_mask) == 0x0,
|
|
|
+ 100, MAX_MODULE_SOFTRESET_WAIT);
|
|
|
+}
|
|
|
+
|
|
|
/* At this point the module is configured enough to read the revision */
|
|
|
static int sysc_init_module(struct sysc *ddata)
|
|
|
{
|
|
@@ -960,6 +998,14 @@ static int sysc_init_module(struct sysc *ddata)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+ error = sysc_reset(ddata);
|
|
|
+ if (error) {
|
|
|
+ dev_err(ddata->dev, "Reset failed with %d\n", error);
|
|
|
+ pm_runtime_put_sync(ddata->dev);
|
|
|
+
|
|
|
+ return error;
|
|
|
+ }
|
|
|
+
|
|
|
ddata->revision = sysc_read_revision(ddata);
|
|
|
pm_runtime_put_sync(ddata->dev);
|
|
|
|
|
@@ -1552,6 +1598,23 @@ static const struct sysc_capabilities sysc_omap4_usb_host_fs = {
|
|
|
.regbits = &sysc_regbits_omap4_usb_host_fs,
|
|
|
};
|
|
|
|
|
|
+static const struct sysc_regbits sysc_regbits_dra7_mcan = {
|
|
|
+ .dmadisable_shift = -ENODEV,
|
|
|
+ .midle_shift = -ENODEV,
|
|
|
+ .sidle_shift = -ENODEV,
|
|
|
+ .clkact_shift = -ENODEV,
|
|
|
+ .enwkup_shift = 4,
|
|
|
+ .srst_shift = 0,
|
|
|
+ .emufree_shift = -ENODEV,
|
|
|
+ .autoidle_shift = -ENODEV,
|
|
|
+};
|
|
|
+
|
|
|
+static const struct sysc_capabilities sysc_dra7_mcan = {
|
|
|
+ .type = TI_SYSC_DRA7_MCAN,
|
|
|
+ .sysc_mask = SYSC_DRA7_MCAN_ENAWAKEUP | SYSC_OMAP4_SOFTRESET,
|
|
|
+ .regbits = &sysc_regbits_dra7_mcan,
|
|
|
+};
|
|
|
+
|
|
|
static int sysc_init_pdata(struct sysc *ddata)
|
|
|
{
|
|
|
struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev);
|
|
@@ -1743,6 +1806,7 @@ static const struct of_device_id sysc_match[] = {
|
|
|
{ .compatible = "ti,sysc-mcasp", .data = &sysc_omap4_mcasp, },
|
|
|
{ .compatible = "ti,sysc-usb-host-fs",
|
|
|
.data = &sysc_omap4_usb_host_fs, },
|
|
|
+ { .compatible = "ti,sysc-dra7-mcan", .data = &sysc_dra7_mcan, },
|
|
|
{ },
|
|
|
};
|
|
|
MODULE_DEVICE_TABLE(of, sysc_match);
|