1 /* $NetBSD: devnodes.c,v 1.12 2016/01/26 23:12:18 pooka Exp $ */ 2 3 /* 4 * Copyright (c) 2009 Antti Kantee. All Rights Reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS 16 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 17 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 21 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 */ 27 28 #include <sys/cdefs.h> 29 __KERNEL_RCSID(0, "$NetBSD: devnodes.c,v 1.12 2016/01/26 23:12:18 pooka Exp $"); 30 31 #include <sys/param.h> 32 #include <sys/device.h> 33 #include <sys/filedesc.h> 34 #include <sys/kmem.h> 35 #include <sys/lwp.h> 36 #include <sys/namei.h> 37 #include <sys/stat.h> 38 #include <sys/vfs_syscalls.h> 39 40 #include <rump-sys/vfs.h> 41 42 /* realqvik(tm) "devfs" */ 43 static int 44 makeonedevnode(dev_t devtype, const char *devname, 45 devmajor_t majnum, devminor_t minnum) 46 { 47 register_t retval; 48 int error; 49 50 error = do_sys_mknod(curlwp, devname, 0666 | devtype, 51 makedev(majnum, minnum), &retval, UIO_SYSSPACE); 52 if (error == EEXIST) /* XXX: should check it's actually the same */ 53 error = 0; 54 55 return error; 56 } 57 58 static int 59 makedevnodes(dev_t devtype, const char *basename, char minchar, 60 devmajor_t maj, devminor_t minnum, int nnodes) 61 { 62 int error = 0; 63 char *devname, *p; 64 size_t devlen; 65 register_t retval; 66 67 devlen = strlen(basename) + 1 + 1; /* +letter +0 */ 68 devname = kmem_zalloc(devlen, KM_SLEEP); 69 strlcpy(devname, basename, devlen); 70 p = devname + devlen-2; 71 72 for (; nnodes > 0; nnodes--, minchar++, minnum++) { 73 KASSERT(minchar <= 'z'); 74 *p = minchar; 75 76 if ((error = do_sys_mknod(curlwp, devname, 0666 | devtype, 77 makedev(maj, minnum), &retval, UIO_SYSSPACE))) { 78 if (error == EEXIST) 79 error = 0; 80 else 81 goto out; 82 } 83 } 84 85 out: 86 kmem_free(devname, devlen); 87 return error; 88 } 89 90 static int 91 makesymlink(const char *dst, const char *src) 92 { 93 94 return do_sys_symlink(dst, src, UIO_SYSSPACE); 95 } 96 97 enum { NOTEXIST, SAME, DIFFERENT }; 98 static int 99 doesitexist(const char *path, bool isblk, devmajor_t dmaj, devminor_t dmin) 100 { 101 struct stat sb; 102 int error; 103 104 error = do_sys_stat(path, 0, &sb); 105 /* even if not ENOENT, we might be able to create it */ 106 if (error) 107 return NOTEXIST; 108 109 if (major(sb.st_rdev) != dmaj || minor(sb.st_rdev) != dmin) 110 return DIFFERENT; 111 if (isblk && !S_ISBLK(sb.st_mode)) 112 return DIFFERENT; 113 if (!isblk && !S_ISCHR(sb.st_mode)) 114 return DIFFERENT; 115 116 return SAME; 117 } 118 119 static void 120 makeonenode(char *buf, size_t len, devmajor_t blk, devmajor_t chr, 121 devminor_t dmin, const char *base, int c1, int c2) 122 { 123 char cstr1[2] = {0,0}, cstr2[2] = {0,0}; 124 register_t rv; 125 int error; 126 127 if (c1 != -1) { 128 cstr1[0] = '0' + c1; 129 cstr1[1] = '\0'; 130 } 131 132 if (c2 != -1) { 133 cstr2[0] = 'a' + c2; 134 cstr2[1] = '\0'; 135 136 } 137 138 /* block device */ 139 snprintf(buf, len, "/dev/%s%s%s", base, cstr1, cstr2); 140 if (blk != NODEVMAJOR) { 141 switch (doesitexist(buf, true, blk, dmin)) { 142 case DIFFERENT: 143 aprint_verbose("mkdevnodes: block device %s " 144 "already exists\n", buf); 145 break; 146 case NOTEXIST: 147 if ((error = do_sys_mknod(curlwp, buf, 0600 | S_IFBLK, 148 makedev(blk, dmin), &rv, UIO_SYSSPACE)) != 0) 149 aprint_verbose("mkdevnodes: failed to " 150 "create %s: %d\n", buf, error); 151 break; 152 case SAME: 153 /* done */ 154 break; 155 } 156 snprintf(buf, len, "/dev/r%s%s%s", base, cstr1, cstr2); 157 } 158 159 switch (doesitexist(buf, true, chr, dmin)) { 160 case DIFFERENT: 161 aprint_verbose("mkdevnodes: character device %s " 162 "already exists\n", buf); 163 break; 164 case NOTEXIST: 165 if ((error = do_sys_mknod(curlwp, buf, 0600 | S_IFCHR, 166 makedev(chr, dmin), &rv, UIO_SYSSPACE)) != 0) 167 aprint_verbose("mkdevnodes: failed to " 168 "create %s: %d\n", buf, error); 169 break; 170 case SAME: 171 /* yeehaa */ 172 break; 173 } 174 } 175 176 void 177 rump_vfs_builddevs(struct devsw_conv *dcvec, size_t dcvecsize) 178 { 179 char *pnbuf = PNBUF_GET(); 180 devminor_t themin; 181 struct devsw_conv *dc; 182 size_t i; 183 int v1, v2; 184 185 rump_vfs_makeonedevnode = makeonedevnode; 186 rump_vfs_makedevnodes = makedevnodes; 187 rump_vfs_makesymlink = makesymlink; 188 189 for (i = 0; i < dcvecsize; i++) { 190 dc = &dcvec[i]; 191 192 switch (dc->d_class) { 193 case DEVNODE_DONTBOTHER: 194 break; 195 case DEVNODE_SINGLE: 196 if (dc->d_flags & DEVNODE_FLAG_ISMINOR0) { 197 themin = dc->d_vectdim[0]; 198 } else { 199 themin = 0; 200 } 201 makeonenode(pnbuf, MAXPATHLEN, 202 dc->d_bmajor, dc->d_cmajor, themin, 203 dc->d_name, -1, -1); 204 break; 205 case DEVNODE_VECTOR: 206 for (v1 = 0; v1 < dc->d_vectdim[0]; v1++) { 207 if (dc->d_vectdim[1] == 0) { 208 makeonenode(pnbuf, MAXPATHLEN, 209 dc->d_bmajor, dc->d_cmajor, 210 v1, dc->d_name, v1, -1); 211 } else { 212 for (v2 = 0; 213 v2 < dc->d_vectdim[1]; v2++) { 214 makeonenode(pnbuf, MAXPATHLEN, 215 dc->d_bmajor, dc->d_cmajor, 216 v1 * dc->d_vectdim[1] + v2, 217 dc->d_name, v1, v2); 218 } 219 } 220 } 221 222 /* add some extra sanity checks here */ 223 if (dc->d_flags & DEVNODE_FLAG_LINKZERO) { 224 /* 225 * ok, so we cheat a bit since 226 * symlink isn't supported on rumpfs ... 227 */ 228 makeonenode(pnbuf, MAXPATHLEN, 229 -1, dc->d_cmajor, 0, dc->d_name, -1, -1); 230 231 } 232 break; 233 } 234 } 235 236 PNBUF_PUT(pnbuf); 237 } 238