1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright(C) 2015 Linaro Limited. All rights reserved. 4 * Author: Mathieu Poirier <mathieu.poirier@linaro.org> 5 */ 6 7 #include <linux/pid_namespace.h> 8 #include <linux/pm_runtime.h> 9 #include <linux/sysfs.h> 10 #include "coresight-etm.h" 11 #include "coresight-priv.h" 12 13 static ssize_t nr_addr_cmp_show(struct device *dev, 14 struct device_attribute *attr, char *buf) 15 { 16 unsigned long val; 17 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 18 19 val = drvdata->nr_addr_cmp; 20 return sprintf(buf, "%#lx\n", val); 21 } 22 static DEVICE_ATTR_RO(nr_addr_cmp); 23 24 static ssize_t nr_cntr_show(struct device *dev, 25 struct device_attribute *attr, char *buf) 26 { unsigned long val; 27 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 28 29 val = drvdata->nr_cntr; 30 return sprintf(buf, "%#lx\n", val); 31 } 32 static DEVICE_ATTR_RO(nr_cntr); 33 34 static ssize_t nr_ctxid_cmp_show(struct device *dev, 35 struct device_attribute *attr, char *buf) 36 { 37 unsigned long val; 38 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 39 40 val = drvdata->nr_ctxid_cmp; 41 return sprintf(buf, "%#lx\n", val); 42 } 43 static DEVICE_ATTR_RO(nr_ctxid_cmp); 44 45 static ssize_t etmsr_show(struct device *dev, 46 struct device_attribute *attr, char *buf) 47 { 48 unsigned long flags, val; 49 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 50 51 pm_runtime_get_sync(drvdata->dev); 52 spin_lock_irqsave(&drvdata->spinlock, flags); 53 CS_UNLOCK(drvdata->base); 54 55 val = etm_readl(drvdata, ETMSR); 56 57 CS_LOCK(drvdata->base); 58 spin_unlock_irqrestore(&drvdata->spinlock, flags); 59 pm_runtime_put(drvdata->dev); 60 61 return sprintf(buf, "%#lx\n", val); 62 } 63 static DEVICE_ATTR_RO(etmsr); 64 65 static ssize_t reset_store(struct device *dev, 66 struct device_attribute *attr, 67 const char *buf, size_t size) 68 { 69 int i, ret; 70 unsigned long val; 71 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 72 struct etm_config *config = &drvdata->config; 73 74 ret = kstrtoul(buf, 16, &val); 75 if (ret) 76 return ret; 77 78 if (val) { 79 spin_lock(&drvdata->spinlock); 80 memset(config, 0, sizeof(struct etm_config)); 81 config->mode = ETM_MODE_EXCLUDE; 82 config->trigger_event = ETM_DEFAULT_EVENT_VAL; 83 for (i = 0; i < drvdata->nr_addr_cmp; i++) { 84 config->addr_type[i] = ETM_ADDR_TYPE_NONE; 85 } 86 87 etm_set_default(config); 88 spin_unlock(&drvdata->spinlock); 89 } 90 91 return size; 92 } 93 static DEVICE_ATTR_WO(reset); 94 95 static ssize_t mode_show(struct device *dev, 96 struct device_attribute *attr, char *buf) 97 { 98 unsigned long val; 99 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 100 struct etm_config *config = &drvdata->config; 101 102 val = config->mode; 103 return sprintf(buf, "%#lx\n", val); 104 } 105 106 static ssize_t mode_store(struct device *dev, 107 struct device_attribute *attr, 108 const char *buf, size_t size) 109 { 110 int ret; 111 unsigned long val; 112 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 113 struct etm_config *config = &drvdata->config; 114 115 ret = kstrtoul(buf, 16, &val); 116 if (ret) 117 return ret; 118 119 spin_lock(&drvdata->spinlock); 120 config->mode = val & ETM_MODE_ALL; 121 122 if (config->mode & ETM_MODE_EXCLUDE) 123 config->enable_ctrl1 |= ETMTECR1_INC_EXC; 124 else 125 config->enable_ctrl1 &= ~ETMTECR1_INC_EXC; 126 127 if (config->mode & ETM_MODE_CYCACC) 128 config->ctrl |= ETMCR_CYC_ACC; 129 else 130 config->ctrl &= ~ETMCR_CYC_ACC; 131 132 if (config->mode & ETM_MODE_STALL) { 133 if (!(drvdata->etmccr & ETMCCR_FIFOFULL)) { 134 dev_warn(drvdata->dev, "stall mode not supported\n"); 135 ret = -EINVAL; 136 goto err_unlock; 137 } 138 config->ctrl |= ETMCR_STALL_MODE; 139 } else 140 config->ctrl &= ~ETMCR_STALL_MODE; 141 142 if (config->mode & ETM_MODE_TIMESTAMP) { 143 if (!(drvdata->etmccer & ETMCCER_TIMESTAMP)) { 144 dev_warn(drvdata->dev, "timestamp not supported\n"); 145 ret = -EINVAL; 146 goto err_unlock; 147 } 148 config->ctrl |= ETMCR_TIMESTAMP_EN; 149 } else 150 config->ctrl &= ~ETMCR_TIMESTAMP_EN; 151 152 if (config->mode & ETM_MODE_CTXID) 153 config->ctrl |= ETMCR_CTXID_SIZE; 154 else 155 config->ctrl &= ~ETMCR_CTXID_SIZE; 156 157 if (config->mode & ETM_MODE_BBROAD) 158 config->ctrl |= ETMCR_BRANCH_BROADCAST; 159 else 160 config->ctrl &= ~ETMCR_BRANCH_BROADCAST; 161 162 if (config->mode & ETM_MODE_RET_STACK) 163 config->ctrl |= ETMCR_RETURN_STACK; 164 else 165 config->ctrl &= ~ETMCR_RETURN_STACK; 166 167 if (config->mode & (ETM_MODE_EXCL_KERN | ETM_MODE_EXCL_USER)) 168 etm_config_trace_mode(config); 169 170 spin_unlock(&drvdata->spinlock); 171 172 return size; 173 174 err_unlock: 175 spin_unlock(&drvdata->spinlock); 176 return ret; 177 } 178 static DEVICE_ATTR_RW(mode); 179 180 static ssize_t trigger_event_show(struct device *dev, 181 struct device_attribute *attr, char *buf) 182 { 183 unsigned long val; 184 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 185 struct etm_config *config = &drvdata->config; 186 187 val = config->trigger_event; 188 return sprintf(buf, "%#lx\n", val); 189 } 190 191 static ssize_t trigger_event_store(struct device *dev, 192 struct device_attribute *attr, 193 const char *buf, size_t size) 194 { 195 int ret; 196 unsigned long val; 197 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 198 struct etm_config *config = &drvdata->config; 199 200 ret = kstrtoul(buf, 16, &val); 201 if (ret) 202 return ret; 203 204 config->trigger_event = val & ETM_EVENT_MASK; 205 206 return size; 207 } 208 static DEVICE_ATTR_RW(trigger_event); 209 210 static ssize_t enable_event_show(struct device *dev, 211 struct device_attribute *attr, char *buf) 212 { 213 unsigned long val; 214 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 215 struct etm_config *config = &drvdata->config; 216 217 val = config->enable_event; 218 return sprintf(buf, "%#lx\n", val); 219 } 220 221 static ssize_t enable_event_store(struct device *dev, 222 struct device_attribute *attr, 223 const char *buf, size_t size) 224 { 225 int ret; 226 unsigned long val; 227 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 228 struct etm_config *config = &drvdata->config; 229 230 ret = kstrtoul(buf, 16, &val); 231 if (ret) 232 return ret; 233 234 config->enable_event = val & ETM_EVENT_MASK; 235 236 return size; 237 } 238 static DEVICE_ATTR_RW(enable_event); 239 240 static ssize_t fifofull_level_show(struct device *dev, 241 struct device_attribute *attr, char *buf) 242 { 243 unsigned long val; 244 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 245 struct etm_config *config = &drvdata->config; 246 247 val = config->fifofull_level; 248 return sprintf(buf, "%#lx\n", val); 249 } 250 251 static ssize_t fifofull_level_store(struct device *dev, 252 struct device_attribute *attr, 253 const char *buf, size_t size) 254 { 255 int ret; 256 unsigned long val; 257 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 258 struct etm_config *config = &drvdata->config; 259 260 ret = kstrtoul(buf, 16, &val); 261 if (ret) 262 return ret; 263 264 config->fifofull_level = val; 265 266 return size; 267 } 268 static DEVICE_ATTR_RW(fifofull_level); 269 270 static ssize_t addr_idx_show(struct device *dev, 271 struct device_attribute *attr, char *buf) 272 { 273 unsigned long val; 274 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 275 struct etm_config *config = &drvdata->config; 276 277 val = config->addr_idx; 278 return sprintf(buf, "%#lx\n", val); 279 } 280 281 static ssize_t addr_idx_store(struct device *dev, 282 struct device_attribute *attr, 283 const char *buf, size_t size) 284 { 285 int ret; 286 unsigned long val; 287 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 288 struct etm_config *config = &drvdata->config; 289 290 ret = kstrtoul(buf, 16, &val); 291 if (ret) 292 return ret; 293 294 if (val >= drvdata->nr_addr_cmp) 295 return -EINVAL; 296 297 /* 298 * Use spinlock to ensure index doesn't change while it gets 299 * dereferenced multiple times within a spinlock block elsewhere. 300 */ 301 spin_lock(&drvdata->spinlock); 302 config->addr_idx = val; 303 spin_unlock(&drvdata->spinlock); 304 305 return size; 306 } 307 static DEVICE_ATTR_RW(addr_idx); 308 309 static ssize_t addr_single_show(struct device *dev, 310 struct device_attribute *attr, char *buf) 311 { 312 u8 idx; 313 unsigned long val; 314 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 315 struct etm_config *config = &drvdata->config; 316 317 spin_lock(&drvdata->spinlock); 318 idx = config->addr_idx; 319 if (!(config->addr_type[idx] == ETM_ADDR_TYPE_NONE || 320 config->addr_type[idx] == ETM_ADDR_TYPE_SINGLE)) { 321 spin_unlock(&drvdata->spinlock); 322 return -EINVAL; 323 } 324 325 val = config->addr_val[idx]; 326 spin_unlock(&drvdata->spinlock); 327 328 return sprintf(buf, "%#lx\n", val); 329 } 330 331 static ssize_t addr_single_store(struct device *dev, 332 struct device_attribute *attr, 333 const char *buf, size_t size) 334 { 335 u8 idx; 336 int ret; 337 unsigned long val; 338 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 339 struct etm_config *config = &drvdata->config; 340 341 ret = kstrtoul(buf, 16, &val); 342 if (ret) 343 return ret; 344 345 spin_lock(&drvdata->spinlock); 346 idx = config->addr_idx; 347 if (!(config->addr_type[idx] == ETM_ADDR_TYPE_NONE || 348 config->addr_type[idx] == ETM_ADDR_TYPE_SINGLE)) { 349 spin_unlock(&drvdata->spinlock); 350 return -EINVAL; 351 } 352 353 config->addr_val[idx] = val; 354 config->addr_type[idx] = ETM_ADDR_TYPE_SINGLE; 355 spin_unlock(&drvdata->spinlock); 356 357 return size; 358 } 359 static DEVICE_ATTR_RW(addr_single); 360 361 static ssize_t addr_range_show(struct device *dev, 362 struct device_attribute *attr, char *buf) 363 { 364 u8 idx; 365 unsigned long val1, val2; 366 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 367 struct etm_config *config = &drvdata->config; 368 369 spin_lock(&drvdata->spinlock); 370 idx = config->addr_idx; 371 if (idx % 2 != 0) { 372 spin_unlock(&drvdata->spinlock); 373 return -EPERM; 374 } 375 if (!((config->addr_type[idx] == ETM_ADDR_TYPE_NONE && 376 config->addr_type[idx + 1] == ETM_ADDR_TYPE_NONE) || 377 (config->addr_type[idx] == ETM_ADDR_TYPE_RANGE && 378 config->addr_type[idx + 1] == ETM_ADDR_TYPE_RANGE))) { 379 spin_unlock(&drvdata->spinlock); 380 return -EPERM; 381 } 382 383 val1 = config->addr_val[idx]; 384 val2 = config->addr_val[idx + 1]; 385 spin_unlock(&drvdata->spinlock); 386 387 return sprintf(buf, "%#lx %#lx\n", val1, val2); 388 } 389 390 static ssize_t addr_range_store(struct device *dev, 391 struct device_attribute *attr, 392 const char *buf, size_t size) 393 { 394 u8 idx; 395 unsigned long val1, val2; 396 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 397 struct etm_config *config = &drvdata->config; 398 399 if (sscanf(buf, "%lx %lx", &val1, &val2) != 2) 400 return -EINVAL; 401 /* Lower address comparator cannot have a higher address value */ 402 if (val1 > val2) 403 return -EINVAL; 404 405 spin_lock(&drvdata->spinlock); 406 idx = config->addr_idx; 407 if (idx % 2 != 0) { 408 spin_unlock(&drvdata->spinlock); 409 return -EPERM; 410 } 411 if (!((config->addr_type[idx] == ETM_ADDR_TYPE_NONE && 412 config->addr_type[idx + 1] == ETM_ADDR_TYPE_NONE) || 413 (config->addr_type[idx] == ETM_ADDR_TYPE_RANGE && 414 config->addr_type[idx + 1] == ETM_ADDR_TYPE_RANGE))) { 415 spin_unlock(&drvdata->spinlock); 416 return -EPERM; 417 } 418 419 config->addr_val[idx] = val1; 420 config->addr_type[idx] = ETM_ADDR_TYPE_RANGE; 421 config->addr_val[idx + 1] = val2; 422 config->addr_type[idx + 1] = ETM_ADDR_TYPE_RANGE; 423 config->enable_ctrl1 |= (1 << (idx/2)); 424 spin_unlock(&drvdata->spinlock); 425 426 return size; 427 } 428 static DEVICE_ATTR_RW(addr_range); 429 430 static ssize_t addr_start_show(struct device *dev, 431 struct device_attribute *attr, char *buf) 432 { 433 u8 idx; 434 unsigned long val; 435 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 436 struct etm_config *config = &drvdata->config; 437 438 spin_lock(&drvdata->spinlock); 439 idx = config->addr_idx; 440 if (!(config->addr_type[idx] == ETM_ADDR_TYPE_NONE || 441 config->addr_type[idx] == ETM_ADDR_TYPE_START)) { 442 spin_unlock(&drvdata->spinlock); 443 return -EPERM; 444 } 445 446 val = config->addr_val[idx]; 447 spin_unlock(&drvdata->spinlock); 448 449 return sprintf(buf, "%#lx\n", val); 450 } 451 452 static ssize_t addr_start_store(struct device *dev, 453 struct device_attribute *attr, 454 const char *buf, size_t size) 455 { 456 u8 idx; 457 int ret; 458 unsigned long val; 459 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 460 struct etm_config *config = &drvdata->config; 461 462 ret = kstrtoul(buf, 16, &val); 463 if (ret) 464 return ret; 465 466 spin_lock(&drvdata->spinlock); 467 idx = config->addr_idx; 468 if (!(config->addr_type[idx] == ETM_ADDR_TYPE_NONE || 469 config->addr_type[idx] == ETM_ADDR_TYPE_START)) { 470 spin_unlock(&drvdata->spinlock); 471 return -EPERM; 472 } 473 474 config->addr_val[idx] = val; 475 config->addr_type[idx] = ETM_ADDR_TYPE_START; 476 config->startstop_ctrl |= (1 << idx); 477 config->enable_ctrl1 |= BIT(25); 478 spin_unlock(&drvdata->spinlock); 479 480 return size; 481 } 482 static DEVICE_ATTR_RW(addr_start); 483 484 static ssize_t addr_stop_show(struct device *dev, 485 struct device_attribute *attr, char *buf) 486 { 487 u8 idx; 488 unsigned long val; 489 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 490 struct etm_config *config = &drvdata->config; 491 492 spin_lock(&drvdata->spinlock); 493 idx = config->addr_idx; 494 if (!(config->addr_type[idx] == ETM_ADDR_TYPE_NONE || 495 config->addr_type[idx] == ETM_ADDR_TYPE_STOP)) { 496 spin_unlock(&drvdata->spinlock); 497 return -EPERM; 498 } 499 500 val = config->addr_val[idx]; 501 spin_unlock(&drvdata->spinlock); 502 503 return sprintf(buf, "%#lx\n", val); 504 } 505 506 static ssize_t addr_stop_store(struct device *dev, 507 struct device_attribute *attr, 508 const char *buf, size_t size) 509 { 510 u8 idx; 511 int ret; 512 unsigned long val; 513 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 514 struct etm_config *config = &drvdata->config; 515 516 ret = kstrtoul(buf, 16, &val); 517 if (ret) 518 return ret; 519 520 spin_lock(&drvdata->spinlock); 521 idx = config->addr_idx; 522 if (!(config->addr_type[idx] == ETM_ADDR_TYPE_NONE || 523 config->addr_type[idx] == ETM_ADDR_TYPE_STOP)) { 524 spin_unlock(&drvdata->spinlock); 525 return -EPERM; 526 } 527 528 config->addr_val[idx] = val; 529 config->addr_type[idx] = ETM_ADDR_TYPE_STOP; 530 config->startstop_ctrl |= (1 << (idx + 16)); 531 config->enable_ctrl1 |= ETMTECR1_START_STOP; 532 spin_unlock(&drvdata->spinlock); 533 534 return size; 535 } 536 static DEVICE_ATTR_RW(addr_stop); 537 538 static ssize_t addr_acctype_show(struct device *dev, 539 struct device_attribute *attr, char *buf) 540 { 541 unsigned long val; 542 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 543 struct etm_config *config = &drvdata->config; 544 545 spin_lock(&drvdata->spinlock); 546 val = config->addr_acctype[config->addr_idx]; 547 spin_unlock(&drvdata->spinlock); 548 549 return sprintf(buf, "%#lx\n", val); 550 } 551 552 static ssize_t addr_acctype_store(struct device *dev, 553 struct device_attribute *attr, 554 const char *buf, size_t size) 555 { 556 int ret; 557 unsigned long val; 558 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 559 struct etm_config *config = &drvdata->config; 560 561 ret = kstrtoul(buf, 16, &val); 562 if (ret) 563 return ret; 564 565 spin_lock(&drvdata->spinlock); 566 config->addr_acctype[config->addr_idx] = val; 567 spin_unlock(&drvdata->spinlock); 568 569 return size; 570 } 571 static DEVICE_ATTR_RW(addr_acctype); 572 573 static ssize_t cntr_idx_show(struct device *dev, 574 struct device_attribute *attr, char *buf) 575 { 576 unsigned long val; 577 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 578 struct etm_config *config = &drvdata->config; 579 580 val = config->cntr_idx; 581 return sprintf(buf, "%#lx\n", val); 582 } 583 584 static ssize_t cntr_idx_store(struct device *dev, 585 struct device_attribute *attr, 586 const char *buf, size_t size) 587 { 588 int ret; 589 unsigned long val; 590 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 591 struct etm_config *config = &drvdata->config; 592 593 ret = kstrtoul(buf, 16, &val); 594 if (ret) 595 return ret; 596 597 if (val >= drvdata->nr_cntr) 598 return -EINVAL; 599 /* 600 * Use spinlock to ensure index doesn't change while it gets 601 * dereferenced multiple times within a spinlock block elsewhere. 602 */ 603 spin_lock(&drvdata->spinlock); 604 config->cntr_idx = val; 605 spin_unlock(&drvdata->spinlock); 606 607 return size; 608 } 609 static DEVICE_ATTR_RW(cntr_idx); 610 611 static ssize_t cntr_rld_val_show(struct device *dev, 612 struct device_attribute *attr, char *buf) 613 { 614 unsigned long val; 615 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 616 struct etm_config *config = &drvdata->config; 617 618 spin_lock(&drvdata->spinlock); 619 val = config->cntr_rld_val[config->cntr_idx]; 620 spin_unlock(&drvdata->spinlock); 621 622 return sprintf(buf, "%#lx\n", val); 623 } 624 625 static ssize_t cntr_rld_val_store(struct device *dev, 626 struct device_attribute *attr, 627 const char *buf, size_t size) 628 { 629 int ret; 630 unsigned long val; 631 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 632 struct etm_config *config = &drvdata->config; 633 634 ret = kstrtoul(buf, 16, &val); 635 if (ret) 636 return ret; 637 638 spin_lock(&drvdata->spinlock); 639 config->cntr_rld_val[config->cntr_idx] = val; 640 spin_unlock(&drvdata->spinlock); 641 642 return size; 643 } 644 static DEVICE_ATTR_RW(cntr_rld_val); 645 646 static ssize_t cntr_event_show(struct device *dev, 647 struct device_attribute *attr, char *buf) 648 { 649 unsigned long val; 650 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 651 struct etm_config *config = &drvdata->config; 652 653 spin_lock(&drvdata->spinlock); 654 val = config->cntr_event[config->cntr_idx]; 655 spin_unlock(&drvdata->spinlock); 656 657 return sprintf(buf, "%#lx\n", val); 658 } 659 660 static ssize_t cntr_event_store(struct device *dev, 661 struct device_attribute *attr, 662 const char *buf, size_t size) 663 { 664 int ret; 665 unsigned long val; 666 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 667 struct etm_config *config = &drvdata->config; 668 669 ret = kstrtoul(buf, 16, &val); 670 if (ret) 671 return ret; 672 673 spin_lock(&drvdata->spinlock); 674 config->cntr_event[config->cntr_idx] = val & ETM_EVENT_MASK; 675 spin_unlock(&drvdata->spinlock); 676 677 return size; 678 } 679 static DEVICE_ATTR_RW(cntr_event); 680 681 static ssize_t cntr_rld_event_show(struct device *dev, 682 struct device_attribute *attr, char *buf) 683 { 684 unsigned long val; 685 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 686 struct etm_config *config = &drvdata->config; 687 688 spin_lock(&drvdata->spinlock); 689 val = config->cntr_rld_event[config->cntr_idx]; 690 spin_unlock(&drvdata->spinlock); 691 692 return sprintf(buf, "%#lx\n", val); 693 } 694 695 static ssize_t cntr_rld_event_store(struct device *dev, 696 struct device_attribute *attr, 697 const char *buf, size_t size) 698 { 699 int ret; 700 unsigned long val; 701 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 702 struct etm_config *config = &drvdata->config; 703 704 ret = kstrtoul(buf, 16, &val); 705 if (ret) 706 return ret; 707 708 spin_lock(&drvdata->spinlock); 709 config->cntr_rld_event[config->cntr_idx] = val & ETM_EVENT_MASK; 710 spin_unlock(&drvdata->spinlock); 711 712 return size; 713 } 714 static DEVICE_ATTR_RW(cntr_rld_event); 715 716 static ssize_t cntr_val_show(struct device *dev, 717 struct device_attribute *attr, char *buf) 718 { 719 int i, ret = 0; 720 u32 val; 721 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 722 struct etm_config *config = &drvdata->config; 723 724 if (!local_read(&drvdata->mode)) { 725 spin_lock(&drvdata->spinlock); 726 for (i = 0; i < drvdata->nr_cntr; i++) 727 ret += sprintf(buf, "counter %d: %x\n", 728 i, config->cntr_val[i]); 729 spin_unlock(&drvdata->spinlock); 730 return ret; 731 } 732 733 for (i = 0; i < drvdata->nr_cntr; i++) { 734 val = etm_readl(drvdata, ETMCNTVRn(i)); 735 ret += sprintf(buf, "counter %d: %x\n", i, val); 736 } 737 738 return ret; 739 } 740 741 static ssize_t cntr_val_store(struct device *dev, 742 struct device_attribute *attr, 743 const char *buf, size_t size) 744 { 745 int ret; 746 unsigned long val; 747 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 748 struct etm_config *config = &drvdata->config; 749 750 ret = kstrtoul(buf, 16, &val); 751 if (ret) 752 return ret; 753 754 spin_lock(&drvdata->spinlock); 755 config->cntr_val[config->cntr_idx] = val; 756 spin_unlock(&drvdata->spinlock); 757 758 return size; 759 } 760 static DEVICE_ATTR_RW(cntr_val); 761 762 static ssize_t seq_12_event_show(struct device *dev, 763 struct device_attribute *attr, char *buf) 764 { 765 unsigned long val; 766 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 767 struct etm_config *config = &drvdata->config; 768 769 val = config->seq_12_event; 770 return sprintf(buf, "%#lx\n", val); 771 } 772 773 static ssize_t seq_12_event_store(struct device *dev, 774 struct device_attribute *attr, 775 const char *buf, size_t size) 776 { 777 int ret; 778 unsigned long val; 779 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 780 struct etm_config *config = &drvdata->config; 781 782 ret = kstrtoul(buf, 16, &val); 783 if (ret) 784 return ret; 785 786 config->seq_12_event = val & ETM_EVENT_MASK; 787 return size; 788 } 789 static DEVICE_ATTR_RW(seq_12_event); 790 791 static ssize_t seq_21_event_show(struct device *dev, 792 struct device_attribute *attr, char *buf) 793 { 794 unsigned long val; 795 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 796 struct etm_config *config = &drvdata->config; 797 798 val = config->seq_21_event; 799 return sprintf(buf, "%#lx\n", val); 800 } 801 802 static ssize_t seq_21_event_store(struct device *dev, 803 struct device_attribute *attr, 804 const char *buf, size_t size) 805 { 806 int ret; 807 unsigned long val; 808 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 809 struct etm_config *config = &drvdata->config; 810 811 ret = kstrtoul(buf, 16, &val); 812 if (ret) 813 return ret; 814 815 config->seq_21_event = val & ETM_EVENT_MASK; 816 return size; 817 } 818 static DEVICE_ATTR_RW(seq_21_event); 819 820 static ssize_t seq_23_event_show(struct device *dev, 821 struct device_attribute *attr, char *buf) 822 { 823 unsigned long val; 824 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 825 struct etm_config *config = &drvdata->config; 826 827 val = config->seq_23_event; 828 return sprintf(buf, "%#lx\n", val); 829 } 830 831 static ssize_t seq_23_event_store(struct device *dev, 832 struct device_attribute *attr, 833 const char *buf, size_t size) 834 { 835 int ret; 836 unsigned long val; 837 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 838 struct etm_config *config = &drvdata->config; 839 840 ret = kstrtoul(buf, 16, &val); 841 if (ret) 842 return ret; 843 844 config->seq_23_event = val & ETM_EVENT_MASK; 845 return size; 846 } 847 static DEVICE_ATTR_RW(seq_23_event); 848 849 static ssize_t seq_31_event_show(struct device *dev, 850 struct device_attribute *attr, char *buf) 851 { 852 unsigned long val; 853 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 854 struct etm_config *config = &drvdata->config; 855 856 val = config->seq_31_event; 857 return sprintf(buf, "%#lx\n", val); 858 } 859 860 static ssize_t seq_31_event_store(struct device *dev, 861 struct device_attribute *attr, 862 const char *buf, size_t size) 863 { 864 int ret; 865 unsigned long val; 866 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 867 struct etm_config *config = &drvdata->config; 868 869 ret = kstrtoul(buf, 16, &val); 870 if (ret) 871 return ret; 872 873 config->seq_31_event = val & ETM_EVENT_MASK; 874 return size; 875 } 876 static DEVICE_ATTR_RW(seq_31_event); 877 878 static ssize_t seq_32_event_show(struct device *dev, 879 struct device_attribute *attr, char *buf) 880 { 881 unsigned long val; 882 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 883 struct etm_config *config = &drvdata->config; 884 885 val = config->seq_32_event; 886 return sprintf(buf, "%#lx\n", val); 887 } 888 889 static ssize_t seq_32_event_store(struct device *dev, 890 struct device_attribute *attr, 891 const char *buf, size_t size) 892 { 893 int ret; 894 unsigned long val; 895 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 896 struct etm_config *config = &drvdata->config; 897 898 ret = kstrtoul(buf, 16, &val); 899 if (ret) 900 return ret; 901 902 config->seq_32_event = val & ETM_EVENT_MASK; 903 return size; 904 } 905 static DEVICE_ATTR_RW(seq_32_event); 906 907 static ssize_t seq_13_event_show(struct device *dev, 908 struct device_attribute *attr, char *buf) 909 { 910 unsigned long val; 911 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 912 struct etm_config *config = &drvdata->config; 913 914 val = config->seq_13_event; 915 return sprintf(buf, "%#lx\n", val); 916 } 917 918 static ssize_t seq_13_event_store(struct device *dev, 919 struct device_attribute *attr, 920 const char *buf, size_t size) 921 { 922 int ret; 923 unsigned long val; 924 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 925 struct etm_config *config = &drvdata->config; 926 927 ret = kstrtoul(buf, 16, &val); 928 if (ret) 929 return ret; 930 931 config->seq_13_event = val & ETM_EVENT_MASK; 932 return size; 933 } 934 static DEVICE_ATTR_RW(seq_13_event); 935 936 static ssize_t seq_curr_state_show(struct device *dev, 937 struct device_attribute *attr, char *buf) 938 { 939 unsigned long val, flags; 940 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 941 struct etm_config *config = &drvdata->config; 942 943 if (!local_read(&drvdata->mode)) { 944 val = config->seq_curr_state; 945 goto out; 946 } 947 948 pm_runtime_get_sync(drvdata->dev); 949 spin_lock_irqsave(&drvdata->spinlock, flags); 950 951 CS_UNLOCK(drvdata->base); 952 val = (etm_readl(drvdata, ETMSQR) & ETM_SQR_MASK); 953 CS_LOCK(drvdata->base); 954 955 spin_unlock_irqrestore(&drvdata->spinlock, flags); 956 pm_runtime_put(drvdata->dev); 957 out: 958 return sprintf(buf, "%#lx\n", val); 959 } 960 961 static ssize_t seq_curr_state_store(struct device *dev, 962 struct device_attribute *attr, 963 const char *buf, size_t size) 964 { 965 int ret; 966 unsigned long val; 967 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 968 struct etm_config *config = &drvdata->config; 969 970 ret = kstrtoul(buf, 16, &val); 971 if (ret) 972 return ret; 973 974 if (val > ETM_SEQ_STATE_MAX_VAL) 975 return -EINVAL; 976 977 config->seq_curr_state = val; 978 979 return size; 980 } 981 static DEVICE_ATTR_RW(seq_curr_state); 982 983 static ssize_t ctxid_idx_show(struct device *dev, 984 struct device_attribute *attr, char *buf) 985 { 986 unsigned long val; 987 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 988 struct etm_config *config = &drvdata->config; 989 990 val = config->ctxid_idx; 991 return sprintf(buf, "%#lx\n", val); 992 } 993 994 static ssize_t ctxid_idx_store(struct device *dev, 995 struct device_attribute *attr, 996 const char *buf, size_t size) 997 { 998 int ret; 999 unsigned long val; 1000 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1001 struct etm_config *config = &drvdata->config; 1002 1003 ret = kstrtoul(buf, 16, &val); 1004 if (ret) 1005 return ret; 1006 1007 if (val >= drvdata->nr_ctxid_cmp) 1008 return -EINVAL; 1009 1010 /* 1011 * Use spinlock to ensure index doesn't change while it gets 1012 * dereferenced multiple times within a spinlock block elsewhere. 1013 */ 1014 spin_lock(&drvdata->spinlock); 1015 config->ctxid_idx = val; 1016 spin_unlock(&drvdata->spinlock); 1017 1018 return size; 1019 } 1020 static DEVICE_ATTR_RW(ctxid_idx); 1021 1022 static ssize_t ctxid_pid_show(struct device *dev, 1023 struct device_attribute *attr, char *buf) 1024 { 1025 unsigned long val; 1026 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1027 struct etm_config *config = &drvdata->config; 1028 1029 /* 1030 * Don't use contextID tracing if coming from a PID namespace. See 1031 * comment in ctxid_pid_store(). 1032 */ 1033 if (task_active_pid_ns(current) != &init_pid_ns) 1034 return -EINVAL; 1035 1036 spin_lock(&drvdata->spinlock); 1037 val = config->ctxid_pid[config->ctxid_idx]; 1038 spin_unlock(&drvdata->spinlock); 1039 1040 return sprintf(buf, "%#lx\n", val); 1041 } 1042 1043 static ssize_t ctxid_pid_store(struct device *dev, 1044 struct device_attribute *attr, 1045 const char *buf, size_t size) 1046 { 1047 int ret; 1048 unsigned long pid; 1049 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1050 struct etm_config *config = &drvdata->config; 1051 1052 /* 1053 * When contextID tracing is enabled the tracers will insert the 1054 * value found in the contextID register in the trace stream. But if 1055 * a process is in a namespace the PID of that process as seen from the 1056 * namespace won't be what the kernel sees, something that makes the 1057 * feature confusing and can potentially leak kernel only information. 1058 * As such refuse to use the feature if @current is not in the initial 1059 * PID namespace. 1060 */ 1061 if (task_active_pid_ns(current) != &init_pid_ns) 1062 return -EINVAL; 1063 1064 ret = kstrtoul(buf, 16, &pid); 1065 if (ret) 1066 return ret; 1067 1068 spin_lock(&drvdata->spinlock); 1069 config->ctxid_pid[config->ctxid_idx] = pid; 1070 spin_unlock(&drvdata->spinlock); 1071 1072 return size; 1073 } 1074 static DEVICE_ATTR_RW(ctxid_pid); 1075 1076 static ssize_t ctxid_mask_show(struct device *dev, 1077 struct device_attribute *attr, char *buf) 1078 { 1079 unsigned long val; 1080 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1081 struct etm_config *config = &drvdata->config; 1082 1083 /* 1084 * Don't use contextID tracing if coming from a PID namespace. See 1085 * comment in ctxid_pid_store(). 1086 */ 1087 if (task_active_pid_ns(current) != &init_pid_ns) 1088 return -EINVAL; 1089 1090 val = config->ctxid_mask; 1091 return sprintf(buf, "%#lx\n", val); 1092 } 1093 1094 static ssize_t ctxid_mask_store(struct device *dev, 1095 struct device_attribute *attr, 1096 const char *buf, size_t size) 1097 { 1098 int ret; 1099 unsigned long val; 1100 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1101 struct etm_config *config = &drvdata->config; 1102 1103 /* 1104 * Don't use contextID tracing if coming from a PID namespace. See 1105 * comment in ctxid_pid_store(). 1106 */ 1107 if (task_active_pid_ns(current) != &init_pid_ns) 1108 return -EINVAL; 1109 1110 ret = kstrtoul(buf, 16, &val); 1111 if (ret) 1112 return ret; 1113 1114 config->ctxid_mask = val; 1115 return size; 1116 } 1117 static DEVICE_ATTR_RW(ctxid_mask); 1118 1119 static ssize_t sync_freq_show(struct device *dev, 1120 struct device_attribute *attr, char *buf) 1121 { 1122 unsigned long val; 1123 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1124 struct etm_config *config = &drvdata->config; 1125 1126 val = config->sync_freq; 1127 return sprintf(buf, "%#lx\n", val); 1128 } 1129 1130 static ssize_t sync_freq_store(struct device *dev, 1131 struct device_attribute *attr, 1132 const char *buf, size_t size) 1133 { 1134 int ret; 1135 unsigned long val; 1136 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1137 struct etm_config *config = &drvdata->config; 1138 1139 ret = kstrtoul(buf, 16, &val); 1140 if (ret) 1141 return ret; 1142 1143 config->sync_freq = val & ETM_SYNC_MASK; 1144 return size; 1145 } 1146 static DEVICE_ATTR_RW(sync_freq); 1147 1148 static ssize_t timestamp_event_show(struct device *dev, 1149 struct device_attribute *attr, char *buf) 1150 { 1151 unsigned long val; 1152 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1153 struct etm_config *config = &drvdata->config; 1154 1155 val = config->timestamp_event; 1156 return sprintf(buf, "%#lx\n", val); 1157 } 1158 1159 static ssize_t timestamp_event_store(struct device *dev, 1160 struct device_attribute *attr, 1161 const char *buf, size_t size) 1162 { 1163 int ret; 1164 unsigned long val; 1165 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1166 struct etm_config *config = &drvdata->config; 1167 1168 ret = kstrtoul(buf, 16, &val); 1169 if (ret) 1170 return ret; 1171 1172 config->timestamp_event = val & ETM_EVENT_MASK; 1173 return size; 1174 } 1175 static DEVICE_ATTR_RW(timestamp_event); 1176 1177 static ssize_t cpu_show(struct device *dev, 1178 struct device_attribute *attr, char *buf) 1179 { 1180 int val; 1181 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1182 1183 val = drvdata->cpu; 1184 return scnprintf(buf, PAGE_SIZE, "%d\n", val); 1185 1186 } 1187 static DEVICE_ATTR_RO(cpu); 1188 1189 static ssize_t traceid_show(struct device *dev, 1190 struct device_attribute *attr, char *buf) 1191 { 1192 unsigned long val; 1193 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1194 1195 val = etm_get_trace_id(drvdata); 1196 1197 return sprintf(buf, "%#lx\n", val); 1198 } 1199 1200 static ssize_t traceid_store(struct device *dev, 1201 struct device_attribute *attr, 1202 const char *buf, size_t size) 1203 { 1204 int ret; 1205 unsigned long val; 1206 struct etm_drvdata *drvdata = dev_get_drvdata(dev->parent); 1207 1208 ret = kstrtoul(buf, 16, &val); 1209 if (ret) 1210 return ret; 1211 1212 drvdata->traceid = val & ETM_TRACEID_MASK; 1213 return size; 1214 } 1215 static DEVICE_ATTR_RW(traceid); 1216 1217 static struct attribute *coresight_etm_attrs[] = { 1218 &dev_attr_nr_addr_cmp.attr, 1219 &dev_attr_nr_cntr.attr, 1220 &dev_attr_nr_ctxid_cmp.attr, 1221 &dev_attr_etmsr.attr, 1222 &dev_attr_reset.attr, 1223 &dev_attr_mode.attr, 1224 &dev_attr_trigger_event.attr, 1225 &dev_attr_enable_event.attr, 1226 &dev_attr_fifofull_level.attr, 1227 &dev_attr_addr_idx.attr, 1228 &dev_attr_addr_single.attr, 1229 &dev_attr_addr_range.attr, 1230 &dev_attr_addr_start.attr, 1231 &dev_attr_addr_stop.attr, 1232 &dev_attr_addr_acctype.attr, 1233 &dev_attr_cntr_idx.attr, 1234 &dev_attr_cntr_rld_val.attr, 1235 &dev_attr_cntr_event.attr, 1236 &dev_attr_cntr_rld_event.attr, 1237 &dev_attr_cntr_val.attr, 1238 &dev_attr_seq_12_event.attr, 1239 &dev_attr_seq_21_event.attr, 1240 &dev_attr_seq_23_event.attr, 1241 &dev_attr_seq_31_event.attr, 1242 &dev_attr_seq_32_event.attr, 1243 &dev_attr_seq_13_event.attr, 1244 &dev_attr_seq_curr_state.attr, 1245 &dev_attr_ctxid_idx.attr, 1246 &dev_attr_ctxid_pid.attr, 1247 &dev_attr_ctxid_mask.attr, 1248 &dev_attr_sync_freq.attr, 1249 &dev_attr_timestamp_event.attr, 1250 &dev_attr_traceid.attr, 1251 &dev_attr_cpu.attr, 1252 NULL, 1253 }; 1254 1255 #define coresight_etm3x_reg(name, offset) \ 1256 coresight_simple_reg32(struct etm_drvdata, name, offset) 1257 1258 coresight_etm3x_reg(etmccr, ETMCCR); 1259 coresight_etm3x_reg(etmccer, ETMCCER); 1260 coresight_etm3x_reg(etmscr, ETMSCR); 1261 coresight_etm3x_reg(etmidr, ETMIDR); 1262 coresight_etm3x_reg(etmcr, ETMCR); 1263 coresight_etm3x_reg(etmtraceidr, ETMTRACEIDR); 1264 coresight_etm3x_reg(etmteevr, ETMTEEVR); 1265 coresight_etm3x_reg(etmtssvr, ETMTSSCR); 1266 coresight_etm3x_reg(etmtecr1, ETMTECR1); 1267 coresight_etm3x_reg(etmtecr2, ETMTECR2); 1268 1269 static struct attribute *coresight_etm_mgmt_attrs[] = { 1270 &dev_attr_etmccr.attr, 1271 &dev_attr_etmccer.attr, 1272 &dev_attr_etmscr.attr, 1273 &dev_attr_etmidr.attr, 1274 &dev_attr_etmcr.attr, 1275 &dev_attr_etmtraceidr.attr, 1276 &dev_attr_etmteevr.attr, 1277 &dev_attr_etmtssvr.attr, 1278 &dev_attr_etmtecr1.attr, 1279 &dev_attr_etmtecr2.attr, 1280 NULL, 1281 }; 1282 1283 static const struct attribute_group coresight_etm_group = { 1284 .attrs = coresight_etm_attrs, 1285 }; 1286 1287 static const struct attribute_group coresight_etm_mgmt_group = { 1288 .attrs = coresight_etm_mgmt_attrs, 1289 .name = "mgmt", 1290 }; 1291 1292 const struct attribute_group *coresight_etm_groups[] = { 1293 &coresight_etm_group, 1294 &coresight_etm_mgmt_group, 1295 NULL, 1296 }; 1297