hc
2024-08-16 a24a44ff9ca902811b99aa9663d697cf452e08ef
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
// SPDX-License-Identifier: GPL-2.0-only
/*
 * framebuffer-coreboot.c
 *
 * Memory based framebuffer accessed through coreboot table.
 *
 * Copyright 2012-2013 David Herrmann <dh.herrmann@gmail.com>
 * Copyright 2017 Google Inc.
 * Copyright 2017 Samuel Holland <samuel@sholland.org>
 */
 
#include <linux/device.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/platform_data/simplefb.h>
#include <linux/platform_device.h>
 
#include "coreboot_table.h"
 
#define CB_TAG_FRAMEBUFFER 0x12
 
static const struct simplefb_format formats[] = SIMPLEFB_FORMATS;
 
static int framebuffer_probe(struct coreboot_device *dev)
{
   int i;
   u32 length;
   struct lb_framebuffer *fb = &dev->framebuffer;
   struct platform_device *pdev;
   struct resource res;
   struct simplefb_platform_data pdata = {
       .width = fb->x_resolution,
       .height = fb->y_resolution,
       .stride = fb->bytes_per_line,
       .format = NULL,
   };
 
   for (i = 0; i < ARRAY_SIZE(formats); ++i) {
       if (fb->bits_per_pixel     == formats[i].bits_per_pixel &&
           fb->red_mask_pos       == formats[i].red.offset &&
           fb->red_mask_size      == formats[i].red.length &&
           fb->green_mask_pos     == formats[i].green.offset &&
           fb->green_mask_size    == formats[i].green.length &&
           fb->blue_mask_pos      == formats[i].blue.offset &&
           fb->blue_mask_size     == formats[i].blue.length &&
           fb->reserved_mask_pos  == formats[i].transp.offset &&
           fb->reserved_mask_size == formats[i].transp.length)
           pdata.format = formats[i].name;
   }
   if (!pdata.format)
       return -ENODEV;
 
   memset(&res, 0, sizeof(res));
   res.flags = IORESOURCE_MEM | IORESOURCE_BUSY;
   res.name = "Coreboot Framebuffer";
   res.start = fb->physical_address;
   length = PAGE_ALIGN(fb->y_resolution * fb->bytes_per_line);
   res.end = res.start + length - 1;
   if (res.end <= res.start)
       return -EINVAL;
 
   pdev = platform_device_register_resndata(&dev->dev,
                        "simple-framebuffer", 0,
                        &res, 1, &pdata,
                        sizeof(pdata));
   if (IS_ERR(pdev))
       pr_warn("coreboot: could not register framebuffer\n");
   else
       dev_set_drvdata(&dev->dev, pdev);
 
   return PTR_ERR_OR_ZERO(pdev);
}
 
static int framebuffer_remove(struct coreboot_device *dev)
{
   struct platform_device *pdev = dev_get_drvdata(&dev->dev);
 
   platform_device_unregister(pdev);
 
   return 0;
}
 
static struct coreboot_driver framebuffer_driver = {
   .probe = framebuffer_probe,
   .remove = framebuffer_remove,
   .drv = {
       .name = "framebuffer",
   },
   .tag = CB_TAG_FRAMEBUFFER,
};
module_coreboot_driver(framebuffer_driver);
 
MODULE_AUTHOR("Samuel Holland <samuel@sholland.org>");
MODULE_LICENSE("GPL");