Merge "coresight: add support for coresight cti save and restore" (2cb4deb5) · Commits · e / devices / android_kernel_sony_msm8994

drivers/coresight/coresight-cti.c

+90 −0

Original line number	Diff line number	Diff line
		@@ -68,6 +68,14 @@ do { \

		#define to_cti_drvdata(c) container_of(c, struct cti_drvdata, cti)

		struct cti_state {
		unsigned int cticontrol;
		unsigned int ctiappset;
		unsigned int ctigate;
		unsigned int ctiinen[CTI_MAX_TRIGGERS];
		unsigned int ctiouten[CTI_MAX_TRIGGERS];
		};

		struct cti_drvdata {
		void __iomem *base;
		struct device *dev;
		@@ -77,6 +85,7 @@ struct cti_drvdata {
		struct coresight_cti cti;
		int refcnt;
		bool cti_save;
		struct cti_state *state;
		};

		static LIST_HEAD(cti_list);
		@@ -1047,6 +1056,14 @@ static int cti_probe(struct platform_device *pdev)
		ret = clk_prepare_enable(drvdata->clk);
		if (ret)
		return ret;

		drvdata->state = devm_kzalloc(dev,
		sizeof(struct cti_state),
		GFP_KERNEL);
		if (!drvdata->state) {
		ret = -ENOMEM;
		goto err;
		}
		}

		mutex_lock(&cti_lock);
		@@ -1089,6 +1106,79 @@ static int cti_remove(struct platform_device *pdev)
		return 0;
		}

		void coresight_cti_ctx_save(void)
		{
		struct cti_drvdata *drvdata;
		struct coresight_cti *cti;
		int trig;

		list_for_each_entry(cti, &cti_list, link) {
		drvdata = to_cti_drvdata(cti);
		if (!drvdata->cti_save)
		continue;

		spin_lock(&drvdata->spinlock);
		if (drvdata->cti_save) {
		drvdata->state->cticontrol =
		cti_readl(drvdata, CTICONTROL);
		drvdata->state->ctiappset =
		cti_readl(drvdata, CTIAPPSET);
		drvdata->state->ctigate =
		cti_readl(drvdata, CTIGATE);
		for (trig = 0;
		trig < CTI_MAX_TRIGGERS;
		trig++) {
		drvdata->state->ctiinen[trig] =
		cti_readl(drvdata, CTIINEN(trig));
		drvdata->state->ctiouten[trig] =
		cti_readl(drvdata, CTIOUTEN(trig));
		}
		}
		spin_unlock(&drvdata->spinlock);
		}
		}
		EXPORT_SYMBOL(coresight_cti_ctx_save);

		void coresight_cti_ctx_restore(void)
		{
		struct cti_drvdata *drvdata;
		struct coresight_cti *cti;
		int trig;

		list_for_each_entry(cti, &cti_list, link) {
		drvdata = to_cti_drvdata(cti);
		if (!drvdata->cti_save)
		continue;

		spin_lock(&drvdata->spinlock);
		if (drvdata->cti_save) {
		CTI_UNLOCK(drvdata);
		cti_writel(drvdata,
		drvdata->state->ctiappset,
		CTIAPPSET);
		cti_writel(drvdata,
		drvdata->state->ctigate,
		CTIGATE);
		for (trig = 0;
		trig < CTI_MAX_TRIGGERS;
		trig++) {
		cti_writel(drvdata,
		drvdata->state->ctiinen[trig],
		CTIINEN(trig));
		cti_writel(drvdata,
		drvdata->state->ctiouten[trig],
		CTIOUTEN(trig));
		}
		cti_writel(drvdata,
		drvdata->state->cticontrol,
		CTICONTROL);
		CTI_LOCK(drvdata);
		}
		spin_unlock(&drvdata->spinlock);
		}
		}
		EXPORT_SYMBOL(coresight_cti_ctx_restore);

		static struct of_device_id cti_match[] = {
		{.compatible = "arm,coresight-cti"},
		{}

include/linux/coresight-cti.h

+5 −1

Original line number	Diff line number	Diff line
		/* Copyright (c) 2013, The Linux Foundation. All rights reserved.
		/* Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License version 2 and
		@@ -40,6 +40,8 @@ extern void coresight_cti_clear_trig(struct coresight_cti *cti, int ch);
		extern int coresight_cti_pulse_trig(struct coresight_cti *cti, int ch);
		extern int coresight_cti_enable_gate(struct coresight_cti *cti, int ch);
		extern void coresight_cti_disable_gate(struct coresight_cti *cti, int ch);
		extern void coresight_cti_ctx_save(void);
		extern void coresight_cti_ctx_restore(void);
		#else
		static inline struct coresight_cti coresight_cti_get(const char name)
		{
		@@ -77,6 +79,8 @@ static inline int coresight_cti_enable_gate(struct coresight_cti *cti, int ch)
		}
		static inline void coresight_cti_disable_gate(struct coresight_cti *cti, int ch)
		{}
		static inline void coresight_cti_ctx_save(void){}
		static inline void coresight_cti_ctx_restore(void){}
		#endif

		#endif