Blame view

kernel/linux-rt-4.4.41/arch/powerpc/platforms/83xx/mpc837x_mds.c 2.64 KB
5113f6f70   김현기   kernel add
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
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
  /*
   * arch/powerpc/platforms/83xx/mpc837x_mds.c
   *
   * Copyright (C) 2007 Freescale Semiconductor, Inc. All rights reserved.
   *
   * MPC837x MDS board specific routines
   *
   * This program is free software; you can redistribute it and/or modify it
   * under the terms of the GNU General Public License as published by the
   * Free Software Foundation;  either version 2 of the License, or (at your
   * option) any later version.
   */
  
  #include <linux/pci.h>
  #include <linux/of.h>
  #include <linux/of_platform.h>
  
  #include <asm/time.h>
  #include <asm/ipic.h>
  #include <asm/udbg.h>
  #include <asm/prom.h>
  #include <sysdev/fsl_pci.h>
  
  #include "mpc83xx.h"
  
  #define BCSR12_USB_SER_MASK	0x8a
  #define BCSR12_USB_SER_PIN	0x80
  #define BCSR12_USB_SER_DEVICE	0x02
  
  static int mpc837xmds_usb_cfg(void)
  {
  	struct device_node *np;
  	const void *phy_type, *mode;
  	void __iomem *bcsr_regs = NULL;
  	u8 bcsr12;
  	int ret;
  
  	ret = mpc837x_usb_cfg();
  	if (ret)
  		return ret;
  	/* Map BCSR area */
  	np = of_find_compatible_node(NULL, NULL, "fsl,mpc837xmds-bcsr");
  	if (np) {
  		bcsr_regs = of_iomap(np, 0);
  		of_node_put(np);
  	}
  	if (!bcsr_regs)
  		return -1;
  
  	np = of_find_node_by_name(NULL, "usb");
  	if (!np) {
  		ret = -ENODEV;
  		goto out;
  	}
  	phy_type = of_get_property(np, "phy_type", NULL);
  	if (phy_type && !strcmp(phy_type, "ulpi")) {
  		clrbits8(bcsr_regs + 12, BCSR12_USB_SER_PIN);
  	} else if (phy_type && !strcmp(phy_type, "serial")) {
  		mode = of_get_property(np, "dr_mode", NULL);
  		bcsr12 = in_8(bcsr_regs + 12) & ~BCSR12_USB_SER_MASK;
  		bcsr12 |= BCSR12_USB_SER_PIN;
  		if (mode && !strcmp(mode, "peripheral"))
  			bcsr12 |= BCSR12_USB_SER_DEVICE;
  		out_8(bcsr_regs + 12, bcsr12);
  	} else {
  		printk(KERN_ERR "USB DR: unsupported PHY
  ");
  	}
  
  	of_node_put(np);
  out:
  	iounmap(bcsr_regs);
  	return ret;
  }
  
  /* ************************************************************************
   *
   * Setup the architecture
   *
   */
  static void __init mpc837x_mds_setup_arch(void)
  {
  	if (ppc_md.progress)
  		ppc_md.progress("mpc837x_mds_setup_arch()", 0);
  
  	mpc83xx_setup_pci();
  	mpc837xmds_usb_cfg();
  }
  
  machine_device_initcall(mpc837x_mds, mpc83xx_declare_of_platform_devices);
  
  /*
   * Called very early, MMU is off, device-tree isn't unflattened
   */
  static int __init mpc837x_mds_probe(void)
  {
          unsigned long root = of_get_flat_dt_root();
  
          return of_flat_dt_is_compatible(root, "fsl,mpc837xmds");
  }
  
  define_machine(mpc837x_mds) {
  	.name			= "MPC837x MDS",
  	.probe			= mpc837x_mds_probe,
  	.setup_arch		= mpc837x_mds_setup_arch,
  	.init_IRQ		= mpc83xx_ipic_init_IRQ,
  	.get_irq		= ipic_get_irq,
  	.restart		= mpc83xx_restart,
  	.time_init		= mpc83xx_time_init,
  	.calibrate_decr		= generic_calibrate_decr,
  	.progress		= udbg_progress,
  };