drivers/video/fbdev/omap2/omapfb/omapfb-sysfs.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * linux/drivers/video/omap2/omapfb-sysfs.c
   4  *
   5  * Copyright (C) 2008 Nokia Corporation
   6  * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
   7  *
   8  * Some code and ideas taken from drivers/video/omap/ driver
   9  * by Imre Deak.
  10  */
  11
  12 #include <linux/fb.h>
  13 #include <linux/sysfs.h>
  14 #include <linux/device.h>
  15 #include <linux/uaccess.h>
  16 #include <linux/platform_device.h>
  17 #include <linux/kernel.h>
  18 #include <linux/mm.h>
  19 #include <linux/omapfb.h>
  20
  21 #include <video/omapfb_dss.h>
  22 #include <video/omapvrfb.h>
  23
  24 #include "omapfb.h"
  25
  26 static ssize_t show_rotate_type(struct device *dev,
  27                 struct device_attribute *attr, char *buf)
  28 {
  29         struct fb_info *fbi = dev_get_drvdata(dev);
  30         struct omapfb_info *ofbi = FB2OFB(fbi);
  31
  32         return sysfs_emit(buf, "%d\n", ofbi->rotation_type);
  33 }
  34
  35 static ssize_t store_rotate_type(struct device *dev,
  36                 struct device_attribute *attr,
  37                 const char *buf, size_t count)
  38 {
  39         struct fb_info *fbi = dev_get_drvdata(dev);
  40         struct omapfb_info *ofbi = FB2OFB(fbi);
  41         struct omapfb2_mem_region *rg;
  42         int rot_type;
  43         int r;
  44
  45         r = kstrtoint(buf, 0, &rot_type);
  46         if (r)
  47                 return r;
  48
  49         if (rot_type != OMAP_DSS_ROT_DMA && rot_type != OMAP_DSS_ROT_VRFB)
  50                 return -EINVAL;
  51
  52         lock_fb_info(fbi);
  53
  54         r = 0;
  55         if (rot_type == ofbi->rotation_type)
  56                 goto out;
  57
  58         rg = omapfb_get_mem_region(ofbi->region);
  59
  60         if (rg->size) {
  61                 r = -EBUSY;
  62                 goto put_region;
  63         }
  64
  65         ofbi->rotation_type = rot_type;
  66
  67         /*
  68          * Since the VRAM for this FB is not allocated at the moment we don't
  69          * need to do any further parameter checking at this point.
  70          */
  71 put_region:
  72         omapfb_put_mem_region(rg);
  73 out:
  74         unlock_fb_info(fbi);
  75
  76         return r ? r : count;
  77 }
  78
  79
  80 static ssize_t show_mirror(struct device *dev,
  81                 struct device_attribute *attr, char *buf)
  82 {
  83         struct fb_info *fbi = dev_get_drvdata(dev);
  84         struct omapfb_info *ofbi = FB2OFB(fbi);
  85
  86         return sysfs_emit(buf, "%d\n", ofbi->mirror);
  87 }
  88
  89 static ssize_t store_mirror(struct device *dev,
  90                 struct device_attribute *attr,
  91                 const char *buf, size_t count)
  92 {
  93         struct fb_info *fbi = dev_get_drvdata(dev);
  94         struct omapfb_info *ofbi = FB2OFB(fbi);
  95         bool mirror;
  96         int r;
  97         struct fb_var_screeninfo new_var;
  98
  99         r = strtobool(buf, &mirror);
 100         if (r)
 101                 return r;
 102
 103         lock_fb_info(fbi);
 104
 105         ofbi->mirror = mirror;
 106
 107         omapfb_get_mem_region(ofbi->region);
 108
 109         memcpy(&new_var, &fbi->var, sizeof(new_var));
 110         r = check_fb_var(fbi, &new_var);
 111         if (r)
 112                 goto out;
 113         memcpy(&fbi->var, &new_var, sizeof(fbi->var));
 114
 115         set_fb_fix(fbi);
 116
 117         r = omapfb_apply_changes(fbi, 0);
 118         if (r)
 119                 goto out;
 120
 121         r = count;
 122 out:
 123         omapfb_put_mem_region(ofbi->region);
 124
 125         unlock_fb_info(fbi);
 126
 127         return r;
 128 }
 129
 130 static ssize_t show_overlays(struct device *dev,
 131                 struct device_attribute *attr, char *buf)
 132 {
 133         struct fb_info *fbi = dev_get_drvdata(dev);
 134         struct omapfb_info *ofbi = FB2OFB(fbi);
 135         struct omapfb2_device *fbdev = ofbi->fbdev;
 136         ssize_t l = 0;
 137         int t;
 138
 139         lock_fb_info(fbi);
 140         omapfb_lock(fbdev);
 141
 142         for (t = 0; t < ofbi->num_overlays; t++) {
 143                 struct omap_overlay *ovl = ofbi->overlays[t];
 144                 int ovlnum;
 145
 146                 for (ovlnum = 0; ovlnum < fbdev->num_overlays; ++ovlnum)
 147                         if (ovl == fbdev->overlays[ovlnum])
 148                                 break;
 149
 150                 l += scnprintf(buf + l, PAGE_SIZE - l, "%s%d",
 151                                 t == 0 ? "" : ",", ovlnum);
 152         }
 153
 154         l += scnprintf(buf + l, PAGE_SIZE - l, "\n");
 155
 156         omapfb_unlock(fbdev);
 157         unlock_fb_info(fbi);
 158
 159         return l;
 160 }
 161
 162 static struct omapfb_info *get_overlay_fb(struct omapfb2_device *fbdev,
 163                 struct omap_overlay *ovl)
 164 {
 165         int i, t;
 166
 167         for (i = 0; i < fbdev->num_fbs; i++) {
 168                 struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]);
 169
 170                 for (t = 0; t < ofbi->num_overlays; t++) {
 171                         if (ofbi->overlays[t] == ovl)
 172                                 return ofbi;
 173                 }
 174         }
 175
 176         return NULL;
 177 }
 178
 179 static ssize_t store_overlays(struct device *dev, struct device_attribute *attr,
 180                 const char *buf, size_t count)
 181 {
 182         struct fb_info *fbi = dev_get_drvdata(dev);
 183         struct omapfb_info *ofbi = FB2OFB(fbi);
 184         struct omapfb2_device *fbdev = ofbi->fbdev;
 185         struct omap_overlay *ovls[OMAPFB_MAX_OVL_PER_FB];
 186         struct omap_overlay *ovl;
 187         int num_ovls, r, i;
 188         int len;
 189         bool added = false;
 190
 191         num_ovls = 0;
 192
 193         len = strlen(buf);
 194         if (buf[len - 1] == '\n')
 195                 len = len - 1;
 196
 197         lock_fb_info(fbi);
 198         omapfb_lock(fbdev);
 199
 200         if (len > 0) {
 201                 char *p = (char *)buf;
 202                 int ovlnum;
 203
 204                 while (p < buf + len) {
 205                         int found;
 206                         if (num_ovls == OMAPFB_MAX_OVL_PER_FB) {
 207                                 r = -EINVAL;
 208                                 goto out;
 209                         }
 210
 211                         ovlnum = simple_strtoul(p, &p, 0);
 212                         if (ovlnum > fbdev->num_overlays) {
 213                                 r = -EINVAL;
 214                                 goto out;
 215                         }
 216
 217                         found = 0;
 218                         for (i = 0; i < num_ovls; ++i) {
 219                                 if (ovls[i] == fbdev->overlays[ovlnum]) {
 220                                         found = 1;
 221                                         break;
 222                                 }
 223                         }
 224
 225                         if (!found)
 226                                 ovls[num_ovls++] = fbdev->overlays[ovlnum];
 227
 228                         p++;
 229                 }
 230         }
 231
 232         for (i = 0; i < num_ovls; ++i) {
 233                 struct omapfb_info *ofbi2 = get_overlay_fb(fbdev, ovls[i]);
 234                 if (ofbi2 && ofbi2 != ofbi) {
 235                         dev_err(fbdev->dev, "overlay already in use\n");
 236                         r = -EINVAL;
 237                         goto out;
 238                 }
 239         }
 240
 241         /* detach unused overlays */
 242         for (i = 0; i < ofbi->num_overlays; ++i) {
 243                 int t, found;
 244
 245                 ovl = ofbi->overlays[i];
 246
 247                 found = 0;
 248
 249                 for (t = 0; t < num_ovls; ++t) {
 250                         if (ovl == ovls[t]) {
 251                                 found = 1;
 252                                 break;
 253                         }
 254                 }
 255
 256                 if (found)
 257                         continue;
 258
 259                 DBG("detaching %d\n", ofbi->overlays[i]->id);
 260
 261                 omapfb_get_mem_region(ofbi->region);
 262
 263                 omapfb_overlay_enable(ovl, 0);
 264
 265                 if (ovl->manager)
 266                         ovl->manager->apply(ovl->manager);
 267
 268                 omapfb_put_mem_region(ofbi->region);
 269
 270                 for (t = i + 1; t < ofbi->num_overlays; t++) {
 271                         ofbi->rotation[t-1] = ofbi->rotation[t];
 272                         ofbi->overlays[t-1] = ofbi->overlays[t];
 273                 }
 274
 275                 ofbi->num_overlays--;
 276                 i--;
 277         }
 278
 279         for (i = 0; i < num_ovls; ++i) {
 280                 int t, found;
 281
 282                 ovl = ovls[i];
 283
 284                 found = 0;
 285
 286                 for (t = 0; t < ofbi->num_overlays; ++t) {
 287                         if (ovl == ofbi->overlays[t]) {
 288                                 found = 1;
 289                                 break;
 290                         }
 291                 }
 292
 293                 if (found)
 294                         continue;
 295                 ofbi->rotation[ofbi->num_overlays] = 0;
 296                 ofbi->overlays[ofbi->num_overlays++] = ovl;
 297
 298                 added = true;
 299         }
 300
 301         if (added) {
 302                 omapfb_get_mem_region(ofbi->region);
 303
 304                 r = omapfb_apply_changes(fbi, 0);
 305
 306                 omapfb_put_mem_region(ofbi->region);
 307
 308                 if (r)
 309                         goto out;
 310         }
 311
 312         r = count;
 313 out:
 314         omapfb_unlock(fbdev);
 315         unlock_fb_info(fbi);
 316
 317         return r;
 318 }
 319
 320 static ssize_t show_overlays_rotate(struct device *dev,
 321                 struct device_attribute *attr, char *buf)
 322 {
 323         struct fb_info *fbi = dev_get_drvdata(dev);
 324         struct omapfb_info *ofbi = FB2OFB(fbi);
 325         ssize_t l = 0;
 326         int t;
 327
 328         lock_fb_info(fbi);
 329
 330         for (t = 0; t < ofbi->num_overlays; t++) {
 331                 l += scnprintf(buf + l, PAGE_SIZE - l, "%s%d",
 332                                 t == 0 ? "" : ",", ofbi->rotation[t]);
 333         }
 334
 335         l += scnprintf(buf + l, PAGE_SIZE - l, "\n");
 336
 337         unlock_fb_info(fbi);
 338
 339         return l;
 340 }
 341
 342 static ssize_t store_overlays_rotate(struct device *dev,
 343                 struct device_attribute *attr, const char *buf, size_t count)
 344 {
 345         struct fb_info *fbi = dev_get_drvdata(dev);
 346         struct omapfb_info *ofbi = FB2OFB(fbi);
 347         int num_ovls = 0, r, i;
 348         int len;
 349         bool changed = false;
 350         u8 rotation[OMAPFB_MAX_OVL_PER_FB];
 351
 352         len = strlen(buf);
 353         if (buf[len - 1] == '\n')
 354                 len = len - 1;
 355
 356         lock_fb_info(fbi);
 357
 358         if (len > 0) {
 359                 char *p = (char *)buf;
 360
 361                 while (p < buf + len) {
 362                         int rot;
 363
 364                         if (num_ovls == ofbi->num_overlays) {
 365                                 r = -EINVAL;
 366                                 goto out;
 367                         }
 368
 369                         rot = simple_strtoul(p, &p, 0);
 370                         if (rot < 0 || rot > 3) {
 371                                 r = -EINVAL;
 372                                 goto out;
 373                         }
 374
 375                         if (ofbi->rotation[num_ovls] != rot)
 376                                 changed = true;
 377
 378                         rotation[num_ovls++] = rot;
 379
 380                         p++;
 381                 }
 382         }
 383
 384         if (num_ovls != ofbi->num_overlays) {
 385                 r = -EINVAL;
 386                 goto out;
 387         }
 388
 389         if (changed) {
 390                 for (i = 0; i < num_ovls; ++i)
 391                         ofbi->rotation[i] = rotation[i];
 392
 393                 omapfb_get_mem_region(ofbi->region);
 394
 395                 r = omapfb_apply_changes(fbi, 0);
 396
 397                 omapfb_put_mem_region(ofbi->region);
 398
 399                 if (r)
 400                         goto out;
 401
 402                 /* FIXME error handling? */
 403         }
 404
 405         r = count;
 406 out:
 407         unlock_fb_info(fbi);
 408
 409         return r;
 410 }
 411
 412 static ssize_t show_size(struct device *dev,
 413                 struct device_attribute *attr, char *buf)
 414 {
 415         struct fb_info *fbi = dev_get_drvdata(dev);
 416         struct omapfb_info *ofbi = FB2OFB(fbi);
 417
 418         return sysfs_emit(buf, "%lu\n", ofbi->region->size);
 419 }
 420
 421 static ssize_t store_size(struct device *dev, struct device_attribute *attr,
 422                 const char *buf, size_t count)
 423 {
 424         struct fb_info *fbi = dev_get_drvdata(dev);
 425         struct omapfb_info *ofbi = FB2OFB(fbi);
 426         struct omapfb2_device *fbdev = ofbi->fbdev;
 427         struct omap_dss_device *display = fb2display(fbi);
 428         struct omapfb2_mem_region *rg;
 429         unsigned long size;
 430         int r;
 431         int i;
 432
 433         r = kstrtoul(buf, 0, &size);
 434         if (r)
 435                 return r;
 436
 437         size = PAGE_ALIGN(size);
 438
 439         lock_fb_info(fbi);
 440
 441         if (display && display->driver->sync)
 442                 display->driver->sync(display);
 443
 444         rg = ofbi->region;
 445
 446         down_write_nested(&rg->lock, rg->id);
 447         atomic_inc(&rg->lock_count);
 448
 449         if (atomic_read(&rg->map_count)) {
 450                 r = -EBUSY;
 451                 goto out;
 452         }
 453
 454         for (i = 0; i < fbdev->num_fbs; i++) {
 455                 struct omapfb_info *ofbi2 = FB2OFB(fbdev->fbs[i]);
 456                 int j;
 457
 458                 if (ofbi2->region != rg)
 459                         continue;
 460
 461                 for (j = 0; j < ofbi2->num_overlays; j++) {
 462                         struct omap_overlay *ovl;
 463                         ovl = ofbi2->overlays[j];
 464                         if (ovl->is_enabled(ovl)) {
 465                                 r = -EBUSY;
 466                                 goto out;
 467                         }
 468                 }
 469         }
 470
 471         if (size != ofbi->region->size) {
 472                 r = omapfb_realloc_fbmem(fbi, size, ofbi->region->type);
 473                 if (r) {
 474                         dev_err(dev, "realloc fbmem failed\n");
 475                         goto out;
 476                 }
 477         }
 478
 479         r = count;
 480 out:
 481         atomic_dec(&rg->lock_count);
 482         up_write(&rg->lock);
 483
 484         unlock_fb_info(fbi);
 485
 486         return r;
 487 }
 488
 489 static ssize_t show_phys(struct device *dev,
 490                 struct device_attribute *attr, char *buf)
 491 {
 492         struct fb_info *fbi = dev_get_drvdata(dev);
 493         struct omapfb_info *ofbi = FB2OFB(fbi);
 494
 495         return sysfs_emit(buf, "%0x\n", ofbi->region->paddr);
 496 }
 497
 498 static ssize_t show_virt(struct device *dev,
 499                 struct device_attribute *attr, char *buf)
 500 {
 501         struct fb_info *fbi = dev_get_drvdata(dev);
 502         struct omapfb_info *ofbi = FB2OFB(fbi);
 503
 504         return sysfs_emit(buf, "%p\n", ofbi->region->vaddr);
 505 }
 506
 507 static ssize_t show_upd_mode(struct device *dev,
 508                 struct device_attribute *attr, char *buf)
 509 {
 510         struct fb_info *fbi = dev_get_drvdata(dev);
 511         enum omapfb_update_mode mode;
 512         int r;
 513
 514         r = omapfb_get_update_mode(fbi, &mode);
 515
 516         if (r)
 517                 return r;
 518
 519         return sysfs_emit(buf, "%u\n", (unsigned int)mode);
 520 }
 521
 522 static ssize_t store_upd_mode(struct device *dev, struct device_attribute *attr,
 523                 const char *buf, size_t count)
 524 {
 525         struct fb_info *fbi = dev_get_drvdata(dev);
 526         unsigned mode;
 527         int r;
 528
 529         r = kstrtouint(buf, 0, &mode);
 530         if (r)
 531                 return r;
 532
 533         r = omapfb_set_update_mode(fbi, mode);
 534         if (r)
 535                 return r;
 536
 537         return count;
 538 }
 539
 540 static struct device_attribute omapfb_attrs[] = {
 541         __ATTR(rotate_type, S_IRUGO | S_IWUSR, show_rotate_type,
 542                         store_rotate_type),
 543         __ATTR(mirror, S_IRUGO | S_IWUSR, show_mirror, store_mirror),
 544         __ATTR(size, S_IRUGO | S_IWUSR, show_size, store_size),
 545         __ATTR(overlays, S_IRUGO | S_IWUSR, show_overlays, store_overlays),
 546         __ATTR(overlays_rotate, S_IRUGO | S_IWUSR, show_overlays_rotate,
 547                         store_overlays_rotate),
 548         __ATTR(phys_addr, S_IRUGO, show_phys, NULL),
 549         __ATTR(virt_addr, S_IRUGO, show_virt, NULL),
 550         __ATTR(update_mode, S_IRUGO | S_IWUSR, show_upd_mode, store_upd_mode),
 551 };
 552
 553 int omapfb_create_sysfs(struct omapfb2_device *fbdev)
 554 {
 555         int i;
 556         int r;
 557
 558         DBG("create sysfs for fbs\n");
 559         for (i = 0; i < fbdev->num_fbs; i++) {
 560                 int t;
 561                 for (t = 0; t < ARRAY_SIZE(omapfb_attrs); t++) {
 562                         r = device_create_file(fbdev->fbs[i]->dev,
 563                                         &omapfb_attrs[t]);
 564
 565                         if (r) {
 566                                 dev_err(fbdev->dev, "failed to create sysfs "
 567                                                 "file\n");
 568                                 return r;
 569                         }
 570                 }
 571         }
 572
 573         return 0;
 574 }
 575
 576 void omapfb_remove_sysfs(struct omapfb2_device *fbdev)
 577 {
 578         int i, t;
 579
 580         DBG("remove sysfs for fbs\n");
 581         for (i = 0; i < fbdev->num_fbs; i++) {
 582                 for (t = 0; t < ARRAY_SIZE(omapfb_attrs); t++)
 583                         device_remove_file(fbdev->fbs[i]->dev,
 584                                         &omapfb_attrs[t]);
 585         }
 586 }
 587