Blame view

kernel/linux-imx6_3.14.28/arch/arm/mach-iop13xx/io.c 2.61 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
  /*
   * iop13xx custom ioremap implementation
   * Copyright (c) 2005-2006, Intel Corporation.
   *
   * This program is free software; you can redistribute it and/or modify it
   * under the terms and conditions of the GNU General Public License,
   * version 2, as published by the Free Software Foundation.
   *
   * This program is distributed in the hope it will be useful, but WITHOUT
   * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
   * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
   * more details.
   *
   * You should have received a copy of the GNU General Public License along with
   * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
   * Place - Suite 330, Boston, MA 02111-1307 USA.
   *
   */
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/io.h>
  #include <mach/hardware.h>
  
  #include "pci.h"
  
  static void __iomem *__iop13xx_ioremap_caller(phys_addr_t cookie,
  	size_t size, unsigned int mtype, void *caller)
  {
  	void __iomem * retval;
  
  	switch (cookie) {
  	case IOP13XX_PCIX_LOWER_MEM_RA ... IOP13XX_PCIX_UPPER_MEM_RA:
  		if (unlikely(!iop13xx_atux_mem_base))
  			retval = NULL;
  		else
  			retval = (iop13xx_atux_mem_base +
  			         (cookie - IOP13XX_PCIX_LOWER_MEM_RA));
  		break;
  	case IOP13XX_PCIE_LOWER_MEM_RA ... IOP13XX_PCIE_UPPER_MEM_RA:
  		if (unlikely(!iop13xx_atue_mem_base))
  			retval = NULL;
  		else
  			retval = (iop13xx_atue_mem_base +
  			         (cookie - IOP13XX_PCIE_LOWER_MEM_RA));
  		break;
  	case IOP13XX_PBI_LOWER_MEM_RA ... IOP13XX_PBI_UPPER_MEM_RA:
  		retval = __arm_ioremap_caller(IOP13XX_PBI_LOWER_MEM_PA +
  				       (cookie - IOP13XX_PBI_LOWER_MEM_RA),
  				       size, mtype, __builtin_return_address(0));
  		break;
  	case IOP13XX_PMMR_PHYS_MEM_BASE ... IOP13XX_PMMR_UPPER_MEM_PA:
  		retval = IOP13XX_PMMR_PHYS_TO_VIRT(cookie);
  		break;
  	default:
  		retval = __arm_ioremap_caller(cookie, size, mtype,
  				caller);
  	}
  
  	return retval;
  }
  
  static void __iop13xx_iounmap(volatile void __iomem *addr)
  {
  	if (iop13xx_atue_mem_base)
  		if (addr >= (void __iomem *) iop13xx_atue_mem_base &&
  	 	    addr < (void __iomem *) (iop13xx_atue_mem_base +
  	 	    			     iop13xx_atue_mem_size))
  		    goto skip;
  
  	if (iop13xx_atux_mem_base)
  		if (addr >= (void __iomem *) iop13xx_atux_mem_base &&
  	 	    addr < (void __iomem *) (iop13xx_atux_mem_base +
  	 	    			     iop13xx_atux_mem_size))
  		    goto skip;
  
  	switch ((u32) addr) {
  	case (u32)IOP13XX_PMMR_VIRT_MEM_BASE ... (u32)IOP13XX_PMMR_UPPER_MEM_VA:
  		goto skip;
  	}
  	__iounmap(addr);
  
  skip:
  	return;
  }
  
  void __init iop13xx_init_early(void)
  {
  	arch_ioremap_caller = __iop13xx_ioremap_caller;
  	arch_iounmap = __iop13xx_iounmap;
  }