arch/mips/kernel/vpe-cmp.c

   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
  19 void cleanup_tc(struct tc *tc)
  20 {
  21
  22 }
  23
  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
  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
  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
  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
  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
 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 }