Blame view

kernel/linux-imx6_3.14.28/drivers/zorro/proc.c 3.45 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
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
  /*
   *	Procfs interface for the Zorro bus.
   *
   *	Copyright (C) 1998-2003 Geert Uytterhoeven
   *
   *	Heavily based on the procfs interface for the PCI bus, which is
   *
   *	Copyright (C) 1997, 1998 Martin Mares <mj@atrey.karlin.mff.cuni.cz>
   */
  
  #include <linux/types.h>
  #include <linux/zorro.h>
  #include <linux/proc_fs.h>
  #include <linux/seq_file.h>
  #include <linux/init.h>
  #include <linux/export.h>
  
  #include <asm/byteorder.h>
  #include <asm/uaccess.h>
  #include <asm/amigahw.h>
  #include <asm/setup.h>
  
  static loff_t
  proc_bus_zorro_lseek(struct file *file, loff_t off, int whence)
  {
  	return fixed_size_llseek(file, off, whence, sizeof(struct ConfigDev));
  }
  
  static ssize_t
  proc_bus_zorro_read(struct file *file, char __user *buf, size_t nbytes, loff_t *ppos)
  {
  	struct zorro_dev *z = PDE_DATA(file_inode(file));
  	struct ConfigDev cd;
  	loff_t pos = *ppos;
  
  	if (pos >= sizeof(struct ConfigDev))
  		return 0;
  	if (nbytes >= sizeof(struct ConfigDev))
  		nbytes = sizeof(struct ConfigDev);
  	if (pos + nbytes > sizeof(struct ConfigDev))
  		nbytes = sizeof(struct ConfigDev) - pos;
  
  	/* Construct a ConfigDev */
  	memset(&cd, 0, sizeof(cd));
  	cd.cd_Rom = z->rom;
  	cd.cd_SlotAddr = cpu_to_be16(z->slotaddr);
  	cd.cd_SlotSize = cpu_to_be16(z->slotsize);
  	cd.cd_BoardAddr = cpu_to_be32(zorro_resource_start(z));
  	cd.cd_BoardSize = cpu_to_be32(zorro_resource_len(z));
  
  	if (copy_to_user(buf, (void *)&cd + pos, nbytes))
  		return -EFAULT;
  	*ppos += nbytes;
  
  	return nbytes;
  }
  
  static const struct file_operations proc_bus_zorro_operations = {
  	.owner		= THIS_MODULE,
  	.llseek		= proc_bus_zorro_lseek,
  	.read		= proc_bus_zorro_read,
  };
  
  static void * zorro_seq_start(struct seq_file *m, loff_t *pos)
  {
  	return (*pos < zorro_num_autocon) ? pos : NULL;
  }
  
  static void * zorro_seq_next(struct seq_file *m, void *v, loff_t *pos)
  {
  	(*pos)++;
  	return (*pos < zorro_num_autocon) ? pos : NULL;
  }
  
  static void zorro_seq_stop(struct seq_file *m, void *v)
  {
  }
  
  static int zorro_seq_show(struct seq_file *m, void *v)
  {
  	unsigned int slot = *(loff_t *)v;
  	struct zorro_dev *z = &zorro_autocon[slot];
  
  	seq_printf(m, "%02x\t%08x\t%08lx\t%08lx\t%02x
  ", slot, z->id,
  		   (unsigned long)zorro_resource_start(z),
  		   (unsigned long)zorro_resource_len(z),
  		   z->rom.er_Type);
  	return 0;
  }
  
  static const struct seq_operations zorro_devices_seq_ops = {
  	.start = zorro_seq_start,
  	.next  = zorro_seq_next,
  	.stop  = zorro_seq_stop,
  	.show  = zorro_seq_show,
  };
  
  static int zorro_devices_proc_open(struct inode *inode, struct file *file)
  {
  	return seq_open(file, &zorro_devices_seq_ops);
  }
  
  static const struct file_operations zorro_devices_proc_fops = {
  	.owner		= THIS_MODULE,
  	.open		= zorro_devices_proc_open,
  	.read		= seq_read,
  	.llseek		= seq_lseek,
  	.release	= seq_release,
  };
  
  static struct proc_dir_entry *proc_bus_zorro_dir;
  
  static int __init zorro_proc_attach_device(unsigned int slot)
  {
  	struct proc_dir_entry *entry;
  	char name[4];
  
  	sprintf(name, "%02x", slot);
  	entry = proc_create_data(name, 0, proc_bus_zorro_dir,
  				 &proc_bus_zorro_operations,
  				 &zorro_autocon[slot]);
  	if (!entry)
  		return -ENOMEM;
  	proc_set_size(entry, sizeof(struct zorro_dev));
  	return 0;
  }
  
  static int __init zorro_proc_init(void)
  {
  	unsigned int slot;
  
  	if (MACH_IS_AMIGA && AMIGAHW_PRESENT(ZORRO)) {
  		proc_bus_zorro_dir = proc_mkdir("bus/zorro", NULL);
  		proc_create("devices", 0, proc_bus_zorro_dir,
  			    &zorro_devices_proc_fops);
  		for (slot = 0; slot < zorro_num_autocon; slot++)
  			zorro_proc_attach_device(slot);
  	}
  	return 0;
  }
  
  device_initcall(zorro_proc_init);