Release 4.11 drivers/dma/ipu/ipu_irq.c

/*
 * Copyright (C) 2008
 * Guennadi Liakhovetski, DENX Software Engineering, <lg@denx.de>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/init.h>
#include <linux/err.h>
#include <linux/spinlock.h>
#include <linux/delay.h>
#include <linux/clk.h>
#include <linux/irq.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/dma/ipu-dma.h>

#include "ipu_intern.h"

/*
 * Register read / write - shall be inlined by the compiler
 */


static u32 ipu_read_reg(struct ipu *ipu, unsigned long reg)
{
	return __raw_readl(ipu->reg_ipu + reg);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
25
100.00%
1
100.00%
Total
25
100.00%
1
100.00%



static void ipu_write_reg(struct ipu *ipu, u32 value, unsigned long reg)
{
	__raw_writel(value, ipu->reg_ipu + reg);
}


Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
29
100.00%
1
100.00%
Total
29
100.00%
1
100.00%

/*
 * IPU IRQ chip driver
 */


#define IPU_IRQ_NR_FN_BANKS 3

#define IPU_IRQ_NR_ERR_BANKS 2

#define IPU_IRQ_NR_BANKS (IPU_IRQ_NR_FN_BANKS + IPU_IRQ_NR_ERR_BANKS)


struct ipu_irq_bank {
	
unsigned int	control;
	
unsigned int	status;
	
struct ipu	*ipu;
};


static struct ipu_irq_bank irq_bank[IPU_IRQ_NR_BANKS] = {
	/* 3 groups of functional interrupts */
	{
		.control	= IPU_INT_CTRL_1,
		.status		= IPU_INT_STAT_1,
        }, {
		.control	= IPU_INT_CTRL_2,
		.status		= IPU_INT_STAT_2,
        }, {
		.control	= IPU_INT_CTRL_3,
		.status		= IPU_INT_STAT_3,
        },
	/* 2 groups of error interrupts */
	{
		.control	= IPU_INT_CTRL_4,
		.status		= IPU_INT_STAT_4,
        }, {
		.control	= IPU_INT_CTRL_5,
		.status		= IPU_INT_STAT_5,
        },
};


struct ipu_irq_map {
	
unsigned int		irq;
	
int			source;
	
struct ipu_irq_bank	*bank;
	
struct ipu		*ipu;
};


static struct ipu_irq_map irq_map[CONFIG_MX3_IPU_IRQS];
/* Protects allocations from the above array of maps */
static DEFINE_MUTEX(map_lock);
/* Protects register accesses and individual mappings */
static DEFINE_RAW_SPINLOCK(bank_lock);



static struct ipu_irq_map *src2map(unsigned int src)
{
	int i;

	for (i = 0; i < CONFIG_MX3_IPU_IRQS; i++)
		if (irq_map[i].source == src)
			return irq_map + i;

	return NULL;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
47
100.00%
1
100.00%
Total
47
100.00%
1
100.00%



static void ipu_irq_unmask(struct irq_data *d)
{
	struct ipu_irq_map *map = irq_data_get_irq_chip_data(d);
	struct ipu_irq_bank *bank;
	uint32_t reg;
	unsigned long lock_flags;

	raw_spin_lock_irqsave(&bank_lock, lock_flags);

	bank = map->bank;
	if (!bank) {
		raw_spin_unlock_irqrestore(&bank_lock, lock_flags);
		pr_err("IPU: %s(%u) - unmapped!\n", __func__, d->irq);
		return;
	}

	reg = ipu_read_reg(bank->ipu, bank->control);
	reg |= (1UL << (map->source & 31));
	ipu_write_reg(bank->ipu, reg, bank->control);

	raw_spin_unlock_irqrestore(&bank_lock, lock_flags);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
111
90.98%
1
33.33%
Thomas Gleixner
8
6.56%
1
33.33%
Uwe Kleine-König
3
2.46%
1
33.33%
Total
122
100.00%
3
100.00%



static void ipu_irq_mask(struct irq_data *d)
{
	struct ipu_irq_map *map = irq_data_get_irq_chip_data(d);
	struct ipu_irq_bank *bank;
	uint32_t reg;
	unsigned long lock_flags;

	raw_spin_lock_irqsave(&bank_lock, lock_flags);

	bank = map->bank;
	if (!bank) {
		raw_spin_unlock_irqrestore(&bank_lock, lock_flags);
		pr_err("IPU: %s(%u) - unmapped!\n", __func__, d->irq);
		return;
	}

	reg = ipu_read_reg(bank->ipu, bank->control);
	reg &= ~(1UL << (map->source & 31));
	ipu_write_reg(bank->ipu, reg, bank->control);

	raw_spin_unlock_irqrestore(&bank_lock, lock_flags);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
112
91.06%
1
33.33%
Thomas Gleixner
8
6.50%
1
33.33%
Uwe Kleine-König
3
2.44%
1
33.33%
Total
123
100.00%
3
100.00%



static void ipu_irq_ack(struct irq_data *d)
{
	struct ipu_irq_map *map = irq_data_get_irq_chip_data(d);
	struct ipu_irq_bank *bank;
	unsigned long lock_flags;

	raw_spin_lock_irqsave(&bank_lock, lock_flags);

	bank = map->bank;
	if (!bank) {
		raw_spin_unlock_irqrestore(&bank_lock, lock_flags);
		pr_err("IPU: %s(%u) - unmapped!\n", __func__, d->irq);
		return;
	}

	ipu_write_reg(bank->ipu, 1UL << (map->source & 31), bank->status);
	raw_spin_unlock_irqrestore(&bank_lock, lock_flags);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
89
89.00%
1
33.33%
Thomas Gleixner
8
8.00%
1
33.33%
Uwe Kleine-König
3
3.00%
1
33.33%
Total
100
100.00%
3
100.00%

/**
 * ipu_irq_status() - returns the current interrupt status of the specified IRQ.
 * @irq:        interrupt line to get status for.
 * @return:     true if the interrupt is pending/asserted or false if the
 *              interrupt is not pending.
 */


bool ipu_irq_status(unsigned int irq)
{
	struct ipu_irq_map *map = irq_get_chip_data(irq);
	struct ipu_irq_bank *bank;
	unsigned long lock_flags;
	bool ret;

	raw_spin_lock_irqsave(&bank_lock, lock_flags);
	bank = map->bank;
	ret = bank && ipu_read_reg(bank->ipu, bank->status) &
		(1UL << (map->source & 31));
	raw_spin_unlock_irqrestore(&bank_lock, lock_flags);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
80
96.39%
1
33.33%
Uwe Kleine-König
2
2.41%
1
33.33%
Thomas Gleixner
1
1.20%
1
33.33%
Total
83
100.00%
3
100.00%

/**
 * ipu_irq_map() - map an IPU interrupt source to an IRQ number
 * @source:     interrupt source bit position (see below)
 * @return:     mapped IRQ number or negative error code
 *
 * The source parameter has to be explained further. On i.MX31 IPU has 137 IRQ
 * sources, they are broken down in 5 32-bit registers, like 32, 32, 24, 32, 17.
 * However, the source argument of this function is not the sequence number of
 * the possible IRQ, but rather its bit position. So, first interrupt in fourth
 * register has source number 96, and not 88. This makes calculations easier,
 * and also provides forward compatibility with any future IPU implementations
 * with any interrupt bit assignments.
 */


int ipu_irq_map(unsigned int source)
{
	int i, ret = -ENOMEM;
	struct ipu_irq_map *map;

	might_sleep();

	mutex_lock(&map_lock);
	map = src2map(source);
	if (map) {
		pr_err("IPU: Source %u already mapped to IRQ %u\n", source, map->irq);
		ret = -EBUSY;
		goto out;
	}

	for (i = 0; i < CONFIG_MX3_IPU_IRQS; i++) {
		if (irq_map[i].source < 0) {
			unsigned long lock_flags;

			raw_spin_lock_irqsave(&bank_lock, lock_flags);
			irq_map[i].source = source;
			irq_map[i].bank = irq_bank + source / 32;
			raw_spin_unlock_irqrestore(&bank_lock, lock_flags);

			ret = irq_map[i].irq;
			pr_debug("IPU: mapped source %u to IRQ %u\n",
				 source, ret);
			break;
		}
	}
out:
	mutex_unlock(&map_lock);

	if (ret < 0)
		pr_err("IPU: couldn't map source %u: %d\n", source, ret);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
176
98.88%
1
50.00%
Uwe Kleine-König
2
1.12%
1
50.00%
Total
178
100.00%
2
100.00%

/**
 * ipu_irq_map() - map an IPU interrupt source to an IRQ number
 * @source:     interrupt source bit position (see ipu_irq_map())
 * @return:     0 or negative error code
 */


int ipu_irq_unmap(unsigned int source)
{
	int i, ret = -EINVAL;

	might_sleep();

	mutex_lock(&map_lock);
	for (i = 0; i < CONFIG_MX3_IPU_IRQS; i++) {
		if (irq_map[i].source == source) {
			unsigned long lock_flags;

			pr_debug("IPU: unmapped source %u from IRQ %u\n",
				 source, irq_map[i].irq);

			raw_spin_lock_irqsave(&bank_lock, lock_flags);
			irq_map[i].source = -EINVAL;
			irq_map[i].bank = NULL;
			raw_spin_unlock_irqrestore(&bank_lock, lock_flags);

			ret = 0;
			break;
		}
	}
	mutex_unlock(&map_lock);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
119
98.35%
1
50.00%
Uwe Kleine-König
2
1.65%
1
50.00%
Total
121
100.00%
2
100.00%

/* Chained IRQ handler for IPU function and error interrupt */


static void ipu_irq_handler(struct irq_desc *desc)
{
	struct ipu *ipu = irq_desc_get_handler_data(desc);
	u32 status;
	int i, line;

	for (i = 0; i < IPU_IRQ_NR_BANKS; i++) {
		struct ipu_irq_bank *bank = irq_bank + i;

		raw_spin_lock(&bank_lock);
		status = ipu_read_reg(ipu, bank->status);
		/*
                 * Don't think we have to clear all interrupts here, they will
                 * be acked by ->handle_irq() (handle_level_irq). However, we
                 * might want to clear unhandled interrupts after the loop...
                 */
		status &= ipu_read_reg(ipu, bank->control);
		raw_spin_unlock(&bank_lock);
		while ((line = ffs(status))) {
			struct ipu_irq_map *map;
			unsigned int irq;

			line--;
			status &= ~(1UL << line);

			raw_spin_lock(&bank_lock);
			map = src2map(32 * i + line);
			if (!map) {
				raw_spin_unlock(&bank_lock);
				pr_err("IPU: Interrupt on unmapped source %u bank %d\n",
				       line, i);
				continue;
			}
			irq = map->irq;
			raw_spin_unlock(&bank_lock);
			generic_handle_irq(irq);
		}
	}
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
153
85.47%
1
14.29%
Arnd Bergmann
14
7.82%
1
14.29%
Thomas Gleixner
5
2.79%
2
28.57%
Uwe Kleine-König
4
2.23%
1
14.29%
Jiang Liu
2
1.12%
1
14.29%
Magnus Lilja
1
0.56%
1
14.29%
Total
179
100.00%
7
100.00%


static struct irq_chip ipu_irq_chip = {
	.name		= "ipu_irq",
	.irq_ack	= ipu_irq_ack,
	.irq_mask	= ipu_irq_mask,
	.irq_unmask	= ipu_irq_unmask,
};

/* Install the IRQ handler */


int __init ipu_irq_attach_irq(struct ipu *ipu, struct platform_device *dev)
{
	unsigned int irq, i;
	int irq_base = irq_alloc_descs(-1, 0, CONFIG_MX3_IPU_IRQS,
				       numa_node_id());

	if (irq_base < 0)
		return irq_base;

	for (i = 0; i < IPU_IRQ_NR_BANKS; i++)
		irq_bank[i].ipu = ipu;

	for (i = 0; i < CONFIG_MX3_IPU_IRQS; i++) {
		int ret;

		irq = irq_base + i;
		ret = irq_set_chip(irq, &ipu_irq_chip);
		if (ret < 0)
			return ret;
		ret = irq_set_chip_data(irq, irq_map + i);
		if (ret < 0)
			return ret;
		irq_map[i].ipu = ipu;
		irq_map[i].irq = irq;
		irq_map[i].source = -EINVAL;
		irq_set_handler(irq, handle_level_irq);
		irq_clear_status_flags(irq, IRQ_NOREQUEST | IRQ_NOPROBE);
	}

	irq_set_chained_handler_and_data(ipu->irq_fn, ipu_irq_handler, ipu);

	irq_set_chained_handler_and_data(ipu->irq_err, ipu_irq_handler, ipu);

	ipu->irq_base = irq_base;

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
166
80.19%
2
28.57%
Shawn Guo
29
14.01%
1
14.29%
Thomas Gleixner
9
4.35%
3
42.86%
Rob Herring
3
1.45%
1
14.29%
Total
207
100.00%
7
100.00%



void ipu_irq_detach_irq(struct ipu *ipu, struct platform_device *dev)
{
	unsigned int irq, irq_base;

	irq_base = ipu->irq_base;

	irq_set_chained_handler_and_data(ipu->irq_fn, NULL, NULL);

	irq_set_chained_handler_and_data(ipu->irq_err, NULL, NULL);

	for (irq = irq_base; irq < irq_base + CONFIG_MX3_IPU_IRQS; irq++) {
		irq_set_status_flags(irq, IRQ_NOREQUEST);
		irq_set_chip(irq, NULL);
		irq_set_chip_data(irq, NULL);
	}
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
80
91.95%
1
20.00%
Thomas Gleixner
4
4.60%
2
40.00%
Rob Herring
2
2.30%
1
20.00%
Shawn Guo
1
1.15%
1
20.00%
Total
87
100.00%
5
100.00%

Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Guennadi Liakhovetski
1389
91.87%
2
15.38%
Thomas Gleixner
47
3.11%
4
30.77%
Shawn Guo
34
2.25%
2
15.38%
Uwe Kleine-König
20
1.32%
1
7.69%
Arnd Bergmann
14
0.93%
1
7.69%
Rob Herring
5
0.33%
1
7.69%
Jiang Liu
2
0.13%
1
7.69%
Magnus Lilja
1
0.07%
1
7.69%
Total
1512
100.00%
13
100.00%
Directory: drivers/dma/ipu

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.