Blame view

kernel/linux-rt-4.4.41/drivers/zorro/zorro-sysfs.c 3.36 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
113
114
115
116
117
118
119
120
121
122
123
124
125
126
  /*
   *  File Attributes for Zorro Devices
   *
   *  Copyright (C) 2003 Geert Uytterhoeven
   *
   *  Loosely based on drivers/pci/pci-sysfs.c
   *
   *  This file is subject to the terms and conditions of the GNU General Public
   *  License.  See the file COPYING in the main directory of this archive
   *  for more details.
   */
  
  
  #include <linux/kernel.h>
  #include <linux/zorro.h>
  #include <linux/stat.h>
  #include <linux/string.h>
  
  #include <asm/byteorder.h>
  
  #include "zorro.h"
  
  
  /* show configuration fields */
  #define zorro_config_attr(name, field, format_string)			\
  static ssize_t								\
  show_##name(struct device *dev, struct device_attribute *attr, char *buf)				\
  {									\
  	struct zorro_dev *z;						\
  									\
  	z = to_zorro_dev(dev);						\
  	return sprintf(buf, format_string, z->field);			\
  }									\
  static DEVICE_ATTR(name, S_IRUGO, show_##name, NULL);
  
  zorro_config_attr(id, id, "0x%08x
  ");
  zorro_config_attr(type, rom.er_Type, "0x%02x
  ");
  zorro_config_attr(slotaddr, slotaddr, "0x%04x
  ");
  zorro_config_attr(slotsize, slotsize, "0x%04x
  ");
  
  static ssize_t
  show_serial(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct zorro_dev *z;
  
  	z = to_zorro_dev(dev);
  	return sprintf(buf, "0x%08x
  ", be32_to_cpu(z->rom.er_SerialNumber));
  }
  
  static DEVICE_ATTR(serial, S_IRUGO, show_serial, NULL);
  
  static ssize_t zorro_show_resource(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct zorro_dev *z = to_zorro_dev(dev);
  
  	return sprintf(buf, "0x%08lx 0x%08lx 0x%08lx
  ",
  		       (unsigned long)zorro_resource_start(z),
  		       (unsigned long)zorro_resource_end(z),
  		       zorro_resource_flags(z));
  }
  
  static DEVICE_ATTR(resource, S_IRUGO, zorro_show_resource, NULL);
  
  static ssize_t zorro_read_config(struct file *filp, struct kobject *kobj,
  				 struct bin_attribute *bin_attr,
  				 char *buf, loff_t off, size_t count)
  {
  	struct zorro_dev *z = to_zorro_dev(container_of(kobj, struct device,
  					   kobj));
  	struct ConfigDev cd;
  
  	/* 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));
  
  	return memory_read_from_buffer(buf, count, &off, &cd, sizeof(cd));
  }
  
  static struct bin_attribute zorro_config_attr = {
  	.attr =	{
  		.name = "config",
  		.mode = S_IRUGO,
  	},
  	.size = sizeof(struct ConfigDev),
  	.read = zorro_read_config,
  };
  
  static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
  			     char *buf)
  {
  	struct zorro_dev *z = to_zorro_dev(dev);
  
  	return sprintf(buf, ZORRO_DEVICE_MODALIAS_FMT "
  ", z->id);
  }
  
  static DEVICE_ATTR(modalias, S_IRUGO, modalias_show, NULL);
  
  int zorro_create_sysfs_dev_files(struct zorro_dev *z)
  {
  	struct device *dev = &z->dev;
  	int error;
  
  	/* current configuration's attributes */
  	if ((error = device_create_file(dev, &dev_attr_id)) ||
  	    (error = device_create_file(dev, &dev_attr_type)) ||
  	    (error = device_create_file(dev, &dev_attr_serial)) ||
  	    (error = device_create_file(dev, &dev_attr_slotaddr)) ||
  	    (error = device_create_file(dev, &dev_attr_slotsize)) ||
  	    (error = device_create_file(dev, &dev_attr_resource)) ||
  	    (error = device_create_file(dev, &dev_attr_modalias)) ||
  	    (error = sysfs_create_bin_file(&dev->kobj, &zorro_config_attr)))
  		return error;
  
  	return 0;
  }