1 /* 2 * net/9p/protocol.c 3 * 4 * 9P Protocol Support Code 5 * 6 * Copyright (C) 2008 by Eric Van Hensbergen <ericvh@gmail.com> 7 * 8 * Base on code from Anthony Liguori <aliguori@us.ibm.com> 9 * Copyright (C) 2008 by IBM, Corp. 10 * 11 * This program is free software; you can redistribute it and/or modify 12 * it under the terms of the GNU General Public License version 2 13 * as published by the Free Software Foundation. 14 * 15 * This program is distributed in the hope that it will be useful, 16 * but WITHOUT ANY WARRANTY; without even the implied warranty of 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 18 * GNU General Public License for more details. 19 * 20 * You should have received a copy of the GNU General Public License 21 * along with this program; if not, write to: 22 * Free Software Foundation 23 * 51 Franklin Street, Fifth Floor 24 * Boston, MA 02111-1301 USA 25 * 26 */ 27 28 #include <linux/module.h> 29 #include <linux/errno.h> 30 #include <linux/kernel.h> 31 #include <linux/uaccess.h> 32 #include <linux/slab.h> 33 #include <linux/sched.h> 34 #include <linux/stddef.h> 35 #include <linux/types.h> 36 #include <linux/uio.h> 37 #include <net/9p/9p.h> 38 #include <net/9p/client.h> 39 #include "protocol.h" 40 41 #include <trace/events/9p.h> 42 43 static int 44 p9pdu_writef(struct p9_fcall *pdu, int proto_version, const char *fmt, ...); 45 46 void p9stat_free(struct p9_wstat *stbuf) 47 { 48 kfree(stbuf->name); 49 kfree(stbuf->uid); 50 kfree(stbuf->gid); 51 kfree(stbuf->muid); 52 kfree(stbuf->extension); 53 } 54 EXPORT_SYMBOL(p9stat_free); 55 56 size_t pdu_read(struct p9_fcall *pdu, void *data, size_t size) 57 { 58 size_t len = min(pdu->size - pdu->offset, size); 59 memcpy(data, &pdu->sdata[pdu->offset], len); 60 pdu->offset += len; 61 return size - len; 62 } 63 64 static size_t pdu_write(struct p9_fcall *pdu, const void *data, size_t size) 65 { 66 size_t len = min(pdu->capacity - pdu->size, size); 67 memcpy(&pdu->sdata[pdu->size], data, len); 68 pdu->size += len; 69 return size - len; 70 } 71 72 static size_t 73 pdu_write_u(struct p9_fcall *pdu, struct iov_iter *from, size_t size) 74 { 75 size_t len = min(pdu->capacity - pdu->size, size); 76 struct iov_iter i = *from; 77 if (copy_from_iter(&pdu->sdata[pdu->size], len, &i) != len) 78 len = 0; 79 80 pdu->size += len; 81 return size - len; 82 } 83 84 /* 85 b - int8_t 86 w - int16_t 87 d - int32_t 88 q - int64_t 89 s - string 90 u - numeric uid 91 g - numeric gid 92 S - stat 93 Q - qid 94 D - data blob (int32_t size followed by void *, results are not freed) 95 T - array of strings (int16_t count, followed by strings) 96 R - array of qids (int16_t count, followed by qids) 97 A - stat for 9p2000.L (p9_stat_dotl) 98 ? - if optional = 1, continue parsing 99 */ 100 101 static int 102 p9pdu_vreadf(struct p9_fcall *pdu, int proto_version, const char *fmt, 103 va_list ap) 104 { 105 const char *ptr; 106 int errcode = 0; 107 108 for (ptr = fmt; *ptr; ptr++) { 109 switch (*ptr) { 110 case 'b':{ 111 int8_t *val = va_arg(ap, int8_t *); 112 if (pdu_read(pdu, val, sizeof(*val))) { 113 errcode = -EFAULT; 114 break; 115 } 116 } 117 break; 118 case 'w':{ 119 int16_t *val = va_arg(ap, int16_t *); 120 __le16 le_val; 121 if (pdu_read(pdu, &le_val, sizeof(le_val))) { 122 errcode = -EFAULT; 123 break; 124 } 125 *val = le16_to_cpu(le_val); 126 } 127 break; 128 case 'd':{ 129 int32_t *val = va_arg(ap, int32_t *); 130 __le32 le_val; 131 if (pdu_read(pdu, &le_val, sizeof(le_val))) { 132 errcode = -EFAULT; 133 break; 134 } 135 *val = le32_to_cpu(le_val); 136 } 137 break; 138 case 'q':{ 139 int64_t *val = va_arg(ap, int64_t *); 140 __le64 le_val; 141 if (pdu_read(pdu, &le_val, sizeof(le_val))) { 142 errcode = -EFAULT; 143 break; 144 } 145 *val = le64_to_cpu(le_val); 146 } 147 break; 148 case 's':{ 149 char **sptr = va_arg(ap, char **); 150 uint16_t len; 151 152 errcode = p9pdu_readf(pdu, proto_version, 153 "w", &len); 154 if (errcode) 155 break; 156 157 *sptr = kmalloc(len + 1, GFP_NOFS); 158 if (*sptr == NULL) { 159 errcode = -EFAULT; 160 break; 161 } 162 if (pdu_read(pdu, *sptr, len)) { 163 errcode = -EFAULT; 164 kfree(*sptr); 165 *sptr = NULL; 166 } else 167 (*sptr)[len] = 0; 168 } 169 break; 170 case 'u': { 171 kuid_t *uid = va_arg(ap, kuid_t *); 172 __le32 le_val; 173 if (pdu_read(pdu, &le_val, sizeof(le_val))) { 174 errcode = -EFAULT; 175 break; 176 } 177 *uid = make_kuid(&init_user_ns, 178 le32_to_cpu(le_val)); 179 } break; 180 case 'g': { 181 kgid_t *gid = va_arg(ap, kgid_t *); 182 __le32 le_val; 183 if (pdu_read(pdu, &le_val, sizeof(le_val))) { 184 errcode = -EFAULT; 185 break; 186 } 187 *gid = make_kgid(&init_user_ns, 188 le32_to_cpu(le_val)); 189 } break; 190 case 'Q':{ 191 struct p9_qid *qid = 192 va_arg(ap, struct p9_qid *); 193 194 errcode = p9pdu_readf(pdu, proto_version, "bdq", 195 &qid->type, &qid->version, 196 &qid->path); 197 } 198 break; 199 case 'S':{ 200 struct p9_wstat *stbuf = 201 va_arg(ap, struct p9_wstat *); 202 203 memset(stbuf, 0, sizeof(struct p9_wstat)); 204 stbuf->n_uid = stbuf->n_muid = INVALID_UID; 205 stbuf->n_gid = INVALID_GID; 206 207 errcode = 208 p9pdu_readf(pdu, proto_version, 209 "wwdQdddqssss?sugu", 210 &stbuf->size, &stbuf->type, 211 &stbuf->dev, &stbuf->qid, 212 &stbuf->mode, &stbuf->atime, 213 &stbuf->mtime, &stbuf->length, 214 &stbuf->name, &stbuf->uid, 215 &stbuf->gid, &stbuf->muid, 216 &stbuf->extension, 217 &stbuf->n_uid, &stbuf->n_gid, 218 &stbuf->n_muid); 219 if (errcode) 220 p9stat_free(stbuf); 221 } 222 break; 223 case 'D':{ 224 uint32_t *count = va_arg(ap, uint32_t *); 225 void **data = va_arg(ap, void **); 226 227 errcode = 228 p9pdu_readf(pdu, proto_version, "d", count); 229 if (!errcode) { 230 *count = 231 min_t(uint32_t, *count, 232 pdu->size - pdu->offset); 233 *data = &pdu->sdata[pdu->offset]; 234 } 235 } 236 break; 237 case 'T':{ 238 uint16_t *nwname = va_arg(ap, uint16_t *); 239 char ***wnames = va_arg(ap, char ***); 240 241 errcode = p9pdu_readf(pdu, proto_version, 242 "w", nwname); 243 if (!errcode) { 244 *wnames = 245 kmalloc(sizeof(char *) * *nwname, 246 GFP_NOFS); 247 if (!*wnames) 248 errcode = -ENOMEM; 249 } 250 251 if (!errcode) { 252 int i; 253 254 for (i = 0; i < *nwname; i++) { 255 errcode = 256 p9pdu_readf(pdu, 257 proto_version, 258 "s", 259 &(*wnames)[i]); 260 if (errcode) 261 break; 262 } 263 } 264 265 if (errcode) { 266 if (*wnames) { 267 int i; 268 269 for (i = 0; i < *nwname; i++) 270 kfree((*wnames)[i]); 271 } 272 kfree(*wnames); 273 *wnames = NULL; 274 } 275 } 276 break; 277 case 'R':{ 278 uint16_t *nwqid = va_arg(ap, uint16_t *); 279 struct p9_qid **wqids = 280 va_arg(ap, struct p9_qid **); 281 282 *wqids = NULL; 283 284 errcode = 285 p9pdu_readf(pdu, proto_version, "w", nwqid); 286 if (!errcode) { 287 *wqids = 288 kmalloc(*nwqid * 289 sizeof(struct p9_qid), 290 GFP_NOFS); 291 if (*wqids == NULL) 292 errcode = -ENOMEM; 293 } 294 295 if (!errcode) { 296 int i; 297 298 for (i = 0; i < *nwqid; i++) { 299 errcode = 300 p9pdu_readf(pdu, 301 proto_version, 302 "Q", 303 &(*wqids)[i]); 304 if (errcode) 305 break; 306 } 307 } 308 309 if (errcode) { 310 kfree(*wqids); 311 *wqids = NULL; 312 } 313 } 314 break; 315 case 'A': { 316 struct p9_stat_dotl *stbuf = 317 va_arg(ap, struct p9_stat_dotl *); 318 319 memset(stbuf, 0, sizeof(struct p9_stat_dotl)); 320 errcode = 321 p9pdu_readf(pdu, proto_version, 322 "qQdugqqqqqqqqqqqqqqq", 323 &stbuf->st_result_mask, 324 &stbuf->qid, 325 &stbuf->st_mode, 326 &stbuf->st_uid, &stbuf->st_gid, 327 &stbuf->st_nlink, 328 &stbuf->st_rdev, &stbuf->st_size, 329 &stbuf->st_blksize, &stbuf->st_blocks, 330 &stbuf->st_atime_sec, 331 &stbuf->st_atime_nsec, 332 &stbuf->st_mtime_sec, 333 &stbuf->st_mtime_nsec, 334 &stbuf->st_ctime_sec, 335 &stbuf->st_ctime_nsec, 336 &stbuf->st_btime_sec, 337 &stbuf->st_btime_nsec, 338 &stbuf->st_gen, 339 &stbuf->st_data_version); 340 } 341 break; 342 case '?': 343 if ((proto_version != p9_proto_2000u) && 344 (proto_version != p9_proto_2000L)) 345 return 0; 346 break; 347 default: 348 BUG(); 349 break; 350 } 351 352 if (errcode) 353 break; 354 } 355 356 return errcode; 357 } 358 359 int 360 p9pdu_vwritef(struct p9_fcall *pdu, int proto_version, const char *fmt, 361 va_list ap) 362 { 363 const char *ptr; 364 int errcode = 0; 365 366 for (ptr = fmt; *ptr; ptr++) { 367 switch (*ptr) { 368 case 'b':{ 369 int8_t val = va_arg(ap, int); 370 if (pdu_write(pdu, &val, sizeof(val))) 371 errcode = -EFAULT; 372 } 373 break; 374 case 'w':{ 375 __le16 val = cpu_to_le16(va_arg(ap, int)); 376 if (pdu_write(pdu, &val, sizeof(val))) 377 errcode = -EFAULT; 378 } 379 break; 380 case 'd':{ 381 __le32 val = cpu_to_le32(va_arg(ap, int32_t)); 382 if (pdu_write(pdu, &val, sizeof(val))) 383 errcode = -EFAULT; 384 } 385 break; 386 case 'q':{ 387 __le64 val = cpu_to_le64(va_arg(ap, int64_t)); 388 if (pdu_write(pdu, &val, sizeof(val))) 389 errcode = -EFAULT; 390 } 391 break; 392 case 's':{ 393 const char *sptr = va_arg(ap, const char *); 394 uint16_t len = 0; 395 if (sptr) 396 len = min_t(size_t, strlen(sptr), 397 USHRT_MAX); 398 399 errcode = p9pdu_writef(pdu, proto_version, 400 "w", len); 401 if (!errcode && pdu_write(pdu, sptr, len)) 402 errcode = -EFAULT; 403 } 404 break; 405 case 'u': { 406 kuid_t uid = va_arg(ap, kuid_t); 407 __le32 val = cpu_to_le32( 408 from_kuid(&init_user_ns, uid)); 409 if (pdu_write(pdu, &val, sizeof(val))) 410 errcode = -EFAULT; 411 } break; 412 case 'g': { 413 kgid_t gid = va_arg(ap, kgid_t); 414 __le32 val = cpu_to_le32( 415 from_kgid(&init_user_ns, gid)); 416 if (pdu_write(pdu, &val, sizeof(val))) 417 errcode = -EFAULT; 418 } break; 419 case 'Q':{ 420 const struct p9_qid *qid = 421 va_arg(ap, const struct p9_qid *); 422 errcode = 423 p9pdu_writef(pdu, proto_version, "bdq", 424 qid->type, qid->version, 425 qid->path); 426 } break; 427 case 'S':{ 428 const struct p9_wstat *stbuf = 429 va_arg(ap, const struct p9_wstat *); 430 errcode = 431 p9pdu_writef(pdu, proto_version, 432 "wwdQdddqssss?sugu", 433 stbuf->size, stbuf->type, 434 stbuf->dev, &stbuf->qid, 435 stbuf->mode, stbuf->atime, 436 stbuf->mtime, stbuf->length, 437 stbuf->name, stbuf->uid, 438 stbuf->gid, stbuf->muid, 439 stbuf->extension, stbuf->n_uid, 440 stbuf->n_gid, stbuf->n_muid); 441 } break; 442 case 'V':{ 443 uint32_t count = va_arg(ap, uint32_t); 444 struct iov_iter *from = 445 va_arg(ap, struct iov_iter *); 446 errcode = p9pdu_writef(pdu, proto_version, "d", 447 count); 448 if (!errcode && pdu_write_u(pdu, from, count)) 449 errcode = -EFAULT; 450 } 451 break; 452 case 'T':{ 453 uint16_t nwname = va_arg(ap, int); 454 const char **wnames = va_arg(ap, const char **); 455 456 errcode = p9pdu_writef(pdu, proto_version, "w", 457 nwname); 458 if (!errcode) { 459 int i; 460 461 for (i = 0; i < nwname; i++) { 462 errcode = 463 p9pdu_writef(pdu, 464 proto_version, 465 "s", 466 wnames[i]); 467 if (errcode) 468 break; 469 } 470 } 471 } 472 break; 473 case 'R':{ 474 uint16_t nwqid = va_arg(ap, int); 475 struct p9_qid *wqids = 476 va_arg(ap, struct p9_qid *); 477 478 errcode = p9pdu_writef(pdu, proto_version, "w", 479 nwqid); 480 if (!errcode) { 481 int i; 482 483 for (i = 0; i < nwqid; i++) { 484 errcode = 485 p9pdu_writef(pdu, 486 proto_version, 487 "Q", 488 &wqids[i]); 489 if (errcode) 490 break; 491 } 492 } 493 } 494 break; 495 case 'I':{ 496 struct p9_iattr_dotl *p9attr = va_arg(ap, 497 struct p9_iattr_dotl *); 498 499 errcode = p9pdu_writef(pdu, proto_version, 500 "ddugqqqqq", 501 p9attr->valid, 502 p9attr->mode, 503 p9attr->uid, 504 p9attr->gid, 505 p9attr->size, 506 p9attr->atime_sec, 507 p9attr->atime_nsec, 508 p9attr->mtime_sec, 509 p9attr->mtime_nsec); 510 } 511 break; 512 case '?': 513 if ((proto_version != p9_proto_2000u) && 514 (proto_version != p9_proto_2000L)) 515 return 0; 516 break; 517 default: 518 BUG(); 519 break; 520 } 521 522 if (errcode) 523 break; 524 } 525 526 return errcode; 527 } 528 529 int p9pdu_readf(struct p9_fcall *pdu, int proto_version, const char *fmt, ...) 530 { 531 va_list ap; 532 int ret; 533 534 va_start(ap, fmt); 535 ret = p9pdu_vreadf(pdu, proto_version, fmt, ap); 536 va_end(ap); 537 538 return ret; 539 } 540 541 static int 542 p9pdu_writef(struct p9_fcall *pdu, int proto_version, const char *fmt, ...) 543 { 544 va_list ap; 545 int ret; 546 547 va_start(ap, fmt); 548 ret = p9pdu_vwritef(pdu, proto_version, fmt, ap); 549 va_end(ap); 550 551 return ret; 552 } 553 554 int p9stat_read(struct p9_client *clnt, char *buf, int len, struct p9_wstat *st) 555 { 556 struct p9_fcall fake_pdu; 557 int ret; 558 559 fake_pdu.size = len; 560 fake_pdu.capacity = len; 561 fake_pdu.sdata = buf; 562 fake_pdu.offset = 0; 563 564 ret = p9pdu_readf(&fake_pdu, clnt->proto_version, "S", st); 565 if (ret) { 566 p9_debug(P9_DEBUG_9P, "<<< p9stat_read failed: %d\n", ret); 567 trace_9p_protocol_dump(clnt, &fake_pdu); 568 } 569 570 return ret; 571 } 572 EXPORT_SYMBOL(p9stat_read); 573 574 int p9pdu_prepare(struct p9_fcall *pdu, int16_t tag, int8_t type) 575 { 576 pdu->id = type; 577 return p9pdu_writef(pdu, 0, "dbw", 0, type, tag); 578 } 579 580 int p9pdu_finalize(struct p9_client *clnt, struct p9_fcall *pdu) 581 { 582 int size = pdu->size; 583 int err; 584 585 pdu->size = 0; 586 err = p9pdu_writef(pdu, 0, "d", size); 587 pdu->size = size; 588 589 trace_9p_protocol_dump(clnt, pdu); 590 p9_debug(P9_DEBUG_9P, ">>> size=%d type: %d tag: %d\n", 591 pdu->size, pdu->id, pdu->tag); 592 593 return err; 594 } 595 596 void p9pdu_reset(struct p9_fcall *pdu) 597 { 598 pdu->offset = 0; 599 pdu->size = 0; 600 } 601 602 int p9dirent_read(struct p9_client *clnt, char *buf, int len, 603 struct p9_dirent *dirent) 604 { 605 struct p9_fcall fake_pdu; 606 int ret; 607 char *nameptr; 608 609 fake_pdu.size = len; 610 fake_pdu.capacity = len; 611 fake_pdu.sdata = buf; 612 fake_pdu.offset = 0; 613 614 ret = p9pdu_readf(&fake_pdu, clnt->proto_version, "Qqbs", &dirent->qid, 615 &dirent->d_off, &dirent->d_type, &nameptr); 616 if (ret) { 617 p9_debug(P9_DEBUG_9P, "<<< p9dirent_read failed: %d\n", ret); 618 trace_9p_protocol_dump(clnt, &fake_pdu); 619 goto out; 620 } 621 622 strcpy(dirent->d_name, nameptr); 623 kfree(nameptr); 624 625 out: 626 return fake_pdu.offset; 627 } 628 EXPORT_SYMBOL(p9dirent_read); 629