• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file "COPYING" in the main directory of this archive
4  * for more details.
5  *
6  * Copyright (C) 2004, 2005 MIPS Technologies, Inc.  All rights reserved.
7  * Copyright (C) 2013 Imagination Technologies Ltd.
8  */
9 #include <linux/kernel.h>
10 #include <linux/device.h>
11 #include <linux/fs.h>
12 #include <linux/slab.h>
13 #include <linux/export.h>
14 
15 #include <asm/vpe.h>
16 
17 static int major;
18 
cleanup_tc(struct tc * tc)19 void cleanup_tc(struct tc *tc)
20 {
21 
22 }
23 
store_kill(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)24 static ssize_t store_kill(struct device *dev, struct device_attribute *attr,
25 			  const char *buf, size_t len)
26 {
27 	struct vpe *vpe = get_vpe(aprp_cpu_index());
28 	struct vpe_notifications *notifier;
29 
30 	list_for_each_entry(notifier, &vpe->notify, list)
31 		notifier->stop(aprp_cpu_index());
32 
33 	release_progmem(vpe->load_addr);
34 	vpe->state = VPE_STATE_UNUSED;
35 
36 	return len;
37 }
38 static DEVICE_ATTR(kill, S_IWUSR, NULL, store_kill);
39 
ntcs_show(struct device * cd,struct device_attribute * attr,char * buf)40 static ssize_t ntcs_show(struct device *cd, struct device_attribute *attr,
41 			 char *buf)
42 {
43 	struct vpe *vpe = get_vpe(aprp_cpu_index());
44 
45 	return sprintf(buf, "%d\n", vpe->ntcs);
46 }
47 
ntcs_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t len)48 static ssize_t ntcs_store(struct device *dev, struct device_attribute *attr,
49 			  const char *buf, size_t len)
50 {
51 	struct vpe *vpe = get_vpe(aprp_cpu_index());
52 	unsigned long new;
53 	int ret;
54 
55 	ret = kstrtoul(buf, 0, &new);
56 	if (ret < 0)
57 		return ret;
58 
59 	/* APRP can only reserve one TC in a VPE and no more. */
60 	if (new != 1)
61 		return -EINVAL;
62 
63 	vpe->ntcs = new;
64 
65 	return len;
66 }
67 static DEVICE_ATTR_RW(ntcs);
68 
69 static struct attribute *vpe_attrs[] = {
70 	&dev_attr_kill.attr,
71 	&dev_attr_ntcs.attr,
72 	NULL,
73 };
74 ATTRIBUTE_GROUPS(vpe);
75 
vpe_device_release(struct device * cd)76 static void vpe_device_release(struct device *cd)
77 {
78 }
79 
80 static struct class vpe_class = {
81 	.name = "vpe",
82 	.owner = THIS_MODULE,
83 	.dev_release = vpe_device_release,
84 	.dev_groups = vpe_groups,
85 };
86 
87 static struct device vpe_device;
88 
vpe_module_init(void)89 int __init vpe_module_init(void)
90 {
91 	struct vpe *v = NULL;
92 	struct tc *t;
93 	int err;
94 
95 	if (!cpu_has_mipsmt) {
96 		pr_warn("VPE loader: not a MIPS MT capable processor\n");
97 		return -ENODEV;
98 	}
99 
100 	if (num_possible_cpus() - aprp_cpu_index() < 1) {
101 		pr_warn("No VPEs reserved for AP/SP, not initialize VPE loader\n"
102 			"Pass maxcpus=<n> argument as kernel argument\n");
103 		return -ENODEV;
104 	}
105 
106 	major = register_chrdev(0, VPE_MODULE_NAME, &vpe_fops);
107 	if (major < 0) {
108 		pr_warn("VPE loader: unable to register character device\n");
109 		return major;
110 	}
111 
112 	err = class_register(&vpe_class);
113 	if (err) {
114 		pr_err("vpe_class registration failed\n");
115 		goto out_chrdev;
116 	}
117 
118 	device_initialize(&vpe_device);
119 	vpe_device.class	= &vpe_class,
120 	vpe_device.parent	= NULL,
121 	dev_set_name(&vpe_device, "vpe_sp");
122 	vpe_device.devt = MKDEV(major, VPE_MODULE_MINOR);
123 	err = device_add(&vpe_device);
124 	if (err) {
125 		pr_err("Adding vpe_device failed\n");
126 		goto out_class;
127 	}
128 
129 	t = alloc_tc(aprp_cpu_index());
130 	if (!t) {
131 		pr_warn("VPE: unable to allocate TC\n");
132 		err = -ENOMEM;
133 		goto out_dev;
134 	}
135 
136 	/* VPE */
137 	v = alloc_vpe(aprp_cpu_index());
138 	if (v == NULL) {
139 		pr_warn("VPE: unable to allocate VPE\n");
140 		kfree(t);
141 		err = -ENOMEM;
142 		goto out_dev;
143 	}
144 
145 	v->ntcs = 1;
146 
147 	/* add the tc to the list of this vpe's tc's. */
148 	list_add(&t->tc, &v->tc);
149 
150 	/* TC */
151 	t->pvpe = v;	/* set the parent vpe */
152 
153 	return 0;
154 
155 out_dev:
156 	device_del(&vpe_device);
157 
158 out_class:
159 	put_device(&vpe_device);
160 	class_unregister(&vpe_class);
161 
162 out_chrdev:
163 	unregister_chrdev(major, VPE_MODULE_NAME);
164 
165 	return err;
166 }
167 
vpe_module_exit(void)168 void __exit vpe_module_exit(void)
169 {
170 	struct vpe *v, *n;
171 
172 	device_unregister(&vpe_device);
173 	class_unregister(&vpe_class);
174 	unregister_chrdev(major, VPE_MODULE_NAME);
175 
176 	/* No locking needed here */
177 	list_for_each_entry_safe(v, n, &vpecontrol.vpe_list, list)
178 		if (v->state != VPE_STATE_UNUSED)
179 			release_vpe(v);
180 }
181