Merge "drivers: irqchip: mpm: Add support to set irq type" (34fe0751) · Commits · e / devices / android_kernel_fairphone_FP3

drivers/irqchip/qcom/mpm.c

+28 −15

Original line number	Diff line number	Diff line
		@@ -162,13 +162,26 @@ static inline void msm_mpm_enable_irq(struct irq_data *d, bool on)
		}
		}

		static inline void msm_mpm_set_type(struct irq_data *d,
		static void msm_mpm_program_set_type(bool set, unsigned int reg,
		unsigned int index, unsigned int mask)
		{
		u32 type;

		type = msm_mpm_read(reg, index);
		if (set)
		type = ENABLE_TYPE(type, mask);
		else
		type = CLEAR_TYPE(type, mask);

		msm_mpm_write(reg, index, type);
		}

		static void msm_mpm_set_type(struct irq_data *d,
		unsigned int flowtype)
		{
		int mpm_pin[MAX_MPM_PIN_PER_IRQ] = {-1, -1};
		unsigned long flags;
		int i = 0;
		u32 type;
		unsigned int index, mask;
		unsigned int reg = 0;

		@@ -180,24 +193,24 @@ static inline void msm_mpm_set_type(struct irq_data *d,
		index = mpm_pin[i]/32;
		mask = mpm_pin[i]%32;

		if (flowtype & IRQ_TYPE_LEVEL_HIGH)
		reg = MPM_REG_FALLING_EDGE;

		if (flowtype & IRQ_TYPE_EDGE_RISING)
		spin_lock_irqsave(&mpm_lock, flags);
		reg = MPM_REG_RISING_EDGE;
		if (flowtype & IRQ_TYPE_EDGE_RISING)
		msm_mpm_program_set_type(1, reg, index, mask);
		else
		msm_mpm_program_set_type(0, reg, index, mask);

		reg = MPM_REG_FALLING_EDGE;
		if (flowtype & IRQ_TYPE_EDGE_FALLING)
		reg = MPM_REG_POLARITY;

		spin_lock_irqsave(&mpm_lock, flags);
		type = msm_mpm_read(reg, index);

		if (flowtype)
		type = ENABLE_TYPE(type, mask);
		msm_mpm_program_set_type(1, reg, index, mask);
		else
		type = CLEAR_TYPE(type, mask);
		msm_mpm_program_set_type(0, reg, index, mask);

		msm_mpm_write(reg, index, type);
		reg = MPM_REG_POLARITY;
		if (flowtype & IRQ_TYPE_LEVEL_HIGH)
		msm_mpm_program_set_type(1, reg, index, mask);
		else
		msm_mpm_program_set_type(0, reg, index, mask);
		spin_unlock_irqrestore(&mpm_lock, flags);
		}
		}