forked from Minki/linux
Compare commits
2 Commits
094226ad94
...
fa8a9017dd
Author | SHA1 | Date | |
---|---|---|---|
fa8a9017dd | |||
|
b2a6e3d183 |
@ -1289,12 +1289,9 @@
|
|||||||
specified address. The serial port must already be
|
specified address. The serial port must already be
|
||||||
setup and configured. Options are not yet supported.
|
setup and configured. Options are not yet supported.
|
||||||
|
|
||||||
efifb,[options]
|
efifb
|
||||||
Start an early, unaccelerated console on the EFI
|
Start an early, unaccelerated console on the EFI
|
||||||
memory mapped framebuffer (if available). On cache
|
memory mapped framebuffer (if available).
|
||||||
coherent non-x86 systems that use system memory for
|
|
||||||
the framebuffer, pass the 'ram' option so that it is
|
|
||||||
mapped with the correct attributes.
|
|
||||||
|
|
||||||
linflex,<addr>
|
linflex,<addr>
|
||||||
Use early console provided by Freescale LINFlexD UART
|
Use early console provided by Freescale LINFlexD UART
|
||||||
@ -1302,6 +1299,11 @@
|
|||||||
address must be provided, and the serial port must
|
address must be provided, and the serial port must
|
||||||
already be setup and configured.
|
already be setup and configured.
|
||||||
|
|
||||||
|
simplefb,<addr>,<width>,<height>,<bpp>
|
||||||
|
Use early console with simple framebuffer that is
|
||||||
|
pre-initialized by firmware. A valid base address,
|
||||||
|
width, height and pixel size must be provided.
|
||||||
|
|
||||||
earlyprintk= [X86,SH,ARM,M68k,S390]
|
earlyprintk= [X86,SH,ARM,M68k,S390]
|
||||||
earlyprintk=vga
|
earlyprintk=vga
|
||||||
earlyprintk=sclp
|
earlyprintk=sclp
|
||||||
|
@ -7285,6 +7285,11 @@ Q: http://patchwork.linuxtv.org/project/linux-media/list/
|
|||||||
T: git git://linuxtv.org/anttip/media_tree.git
|
T: git git://linuxtv.org/anttip/media_tree.git
|
||||||
F: drivers/media/tuners/e4000*
|
F: drivers/media/tuners/e4000*
|
||||||
|
|
||||||
|
EARLY CONSOLE FRAMEBUFFER DRIVER
|
||||||
|
M: Markuss Broks <markuss.broks@gmail.com>
|
||||||
|
S: Maintained
|
||||||
|
F: drivers/video/fbdev/earlycon.c
|
||||||
|
|
||||||
EARTH_PT1 MEDIA DRIVER
|
EARTH_PT1 MEDIA DRIVER
|
||||||
M: Akihiro Tsukada <tskd08@gmail.com>
|
M: Akihiro Tsukada <tskd08@gmail.com>
|
||||||
L: linux-media@vger.kernel.org
|
L: linux-media@vger.kernel.org
|
||||||
|
@ -3,6 +3,7 @@ dtb-$(CONFIG_ARCH_EXYNOS) += \
|
|||||||
exynos5433-tm2.dtb \
|
exynos5433-tm2.dtb \
|
||||||
exynos5433-tm2e.dtb \
|
exynos5433-tm2e.dtb \
|
||||||
exynos7-espresso.dtb \
|
exynos7-espresso.dtb \
|
||||||
|
exynos7885-a10.dtb \
|
||||||
exynos7885-jackpotlte.dtb \
|
exynos7885-jackpotlte.dtb \
|
||||||
exynos850-e850-96.dtb \
|
exynos850-e850-96.dtb \
|
||||||
exynosautov9-sadk.dtb
|
exynosautov9-sadk.dtb
|
||||||
|
47
arch/arm64/boot/dts/exynos/exynos7885-a10.dts
Normal file
47
arch/arm64/boot/dts/exynos/exynos7885-a10.dts
Normal file
@ -0,0 +1,47 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2021, Leandro Friedrich <email@leandrofriedrich.de>
|
||||||
|
*/
|
||||||
|
|
||||||
|
/dts-v1/;
|
||||||
|
#include "exynos7885.dtsi"
|
||||||
|
|
||||||
|
/ {
|
||||||
|
model = "Samsung Galaxy A10";
|
||||||
|
compatible = "samsung,a10", "samsung,exynos7885";
|
||||||
|
|
||||||
|
#address-cells = <2>;
|
||||||
|
#size-cells = <2>;
|
||||||
|
|
||||||
|
chosen {
|
||||||
|
#address-cells = <2>;
|
||||||
|
#size-cells = <2>;
|
||||||
|
ranges;
|
||||||
|
stdout-path = "/chosen/framebuffer@0xec000000";
|
||||||
|
framebuffer@0xec000000 {
|
||||||
|
compatible = "simple-framebuffer";
|
||||||
|
reg = <0x0 0xec000000 0x0 (720*1520*4)>;
|
||||||
|
width = <720>;
|
||||||
|
height = <1520>;
|
||||||
|
stride = <(720 * 4)>;
|
||||||
|
format = "a8r8g8b8";
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
memory@80000000 {
|
||||||
|
device_type = "memory";
|
||||||
|
reg = <0x0 0x80000000 0x3da00000>,
|
||||||
|
<0x0 0xc0000000 0x40000000>,
|
||||||
|
<0x8 0x80000000 0x40000000>;
|
||||||
|
};
|
||||||
|
|
||||||
|
reserved-memory {
|
||||||
|
#address-cells = <2>;
|
||||||
|
#size-cells = <2>;
|
||||||
|
ranges;
|
||||||
|
framebuffer@0xec000000 {
|
||||||
|
reg = <0x0 0xec000000 0x0 (720*1520*4)>;
|
||||||
|
no-map;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
};
|
5379
arch/arm64/configs/jackpotlte_defconfig
Normal file
5379
arch/arm64/configs/jackpotlte_defconfig
Normal file
File diff suppressed because it is too large
Load Diff
@ -268,10 +268,8 @@ config EFI_DISABLE_PCI_DMA
|
|||||||
may be used to override this option.
|
may be used to override this option.
|
||||||
|
|
||||||
config EFI_EARLYCON
|
config EFI_EARLYCON
|
||||||
def_bool y
|
bool "EFI early console support"
|
||||||
depends on SERIAL_EARLYCON && !ARM && !IA64
|
depends on FB_EARLYCON && !IA64
|
||||||
select FONT_SUPPORT
|
|
||||||
select ARCH_USE_MEMREMAP_PROT
|
|
||||||
|
|
||||||
config EFI_CUSTOM_SSDT_OVERLAYS
|
config EFI_CUSTOM_SSDT_OVERLAYS
|
||||||
bool "Load custom ACPI SSDT overlay from an EFI variable"
|
bool "Load custom ACPI SSDT overlay from an EFI variable"
|
||||||
|
@ -43,6 +43,5 @@ obj-$(CONFIG_ARM64) += $(arm-obj-y)
|
|||||||
riscv-obj-$(CONFIG_EFI) := efi-init.o riscv-runtime.o
|
riscv-obj-$(CONFIG_EFI) := efi-init.o riscv-runtime.o
|
||||||
obj-$(CONFIG_RISCV) += $(riscv-obj-y)
|
obj-$(CONFIG_RISCV) += $(riscv-obj-y)
|
||||||
obj-$(CONFIG_EFI_CAPSULE_LOADER) += capsule-loader.o
|
obj-$(CONFIG_EFI_CAPSULE_LOADER) += capsule-loader.o
|
||||||
obj-$(CONFIG_EFI_EARLYCON) += earlycon.o
|
|
||||||
obj-$(CONFIG_UEFI_CPER_ARM) += cper-arm.o
|
obj-$(CONFIG_UEFI_CPER_ARM) += cper-arm.o
|
||||||
obj-$(CONFIG_UEFI_CPER_X86) += cper-x86.o
|
obj-$(CONFIG_UEFI_CPER_X86) += cper-x86.o
|
||||||
|
@ -1,246 +0,0 @@
|
|||||||
// SPDX-License-Identifier: GPL-2.0
|
|
||||||
/*
|
|
||||||
* Copyright (C) 2013 Intel Corporation; author Matt Fleming
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <linux/console.h>
|
|
||||||
#include <linux/efi.h>
|
|
||||||
#include <linux/font.h>
|
|
||||||
#include <linux/io.h>
|
|
||||||
#include <linux/kernel.h>
|
|
||||||
#include <linux/serial_core.h>
|
|
||||||
#include <linux/screen_info.h>
|
|
||||||
|
|
||||||
#include <asm/early_ioremap.h>
|
|
||||||
|
|
||||||
static const struct console *earlycon_console __initdata;
|
|
||||||
static const struct font_desc *font;
|
|
||||||
static u32 efi_x, efi_y;
|
|
||||||
static u64 fb_base;
|
|
||||||
static bool fb_wb;
|
|
||||||
static void *efi_fb;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* EFI earlycon needs to use early_memremap() to map the framebuffer.
|
|
||||||
* But early_memremap() is not usable for 'earlycon=efifb keep_bootcon',
|
|
||||||
* memremap() should be used instead. memremap() will be available after
|
|
||||||
* paging_init() which is earlier than initcall callbacks. Thus adding this
|
|
||||||
* early initcall function early_efi_map_fb() to map the whole EFI framebuffer.
|
|
||||||
*/
|
|
||||||
static int __init efi_earlycon_remap_fb(void)
|
|
||||||
{
|
|
||||||
/* bail if there is no bootconsole or it has been disabled already */
|
|
||||||
if (!earlycon_console || !(earlycon_console->flags & CON_ENABLED))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
efi_fb = memremap(fb_base, screen_info.lfb_size,
|
|
||||||
fb_wb ? MEMREMAP_WB : MEMREMAP_WC);
|
|
||||||
|
|
||||||
return efi_fb ? 0 : -ENOMEM;
|
|
||||||
}
|
|
||||||
early_initcall(efi_earlycon_remap_fb);
|
|
||||||
|
|
||||||
static int __init efi_earlycon_unmap_fb(void)
|
|
||||||
{
|
|
||||||
/* unmap the bootconsole fb unless keep_bootcon has left it enabled */
|
|
||||||
if (efi_fb && !(earlycon_console->flags & CON_ENABLED))
|
|
||||||
memunmap(efi_fb);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
late_initcall(efi_earlycon_unmap_fb);
|
|
||||||
|
|
||||||
static __ref void *efi_earlycon_map(unsigned long start, unsigned long len)
|
|
||||||
{
|
|
||||||
pgprot_t fb_prot;
|
|
||||||
|
|
||||||
if (efi_fb)
|
|
||||||
return efi_fb + start;
|
|
||||||
|
|
||||||
fb_prot = fb_wb ? PAGE_KERNEL : pgprot_writecombine(PAGE_KERNEL);
|
|
||||||
return early_memremap_prot(fb_base + start, len, pgprot_val(fb_prot));
|
|
||||||
}
|
|
||||||
|
|
||||||
static __ref void efi_earlycon_unmap(void *addr, unsigned long len)
|
|
||||||
{
|
|
||||||
if (efi_fb)
|
|
||||||
return;
|
|
||||||
|
|
||||||
early_memunmap(addr, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void efi_earlycon_clear_scanline(unsigned int y)
|
|
||||||
{
|
|
||||||
unsigned long *dst;
|
|
||||||
u16 len;
|
|
||||||
|
|
||||||
len = screen_info.lfb_linelength;
|
|
||||||
dst = efi_earlycon_map(y*len, len);
|
|
||||||
if (!dst)
|
|
||||||
return;
|
|
||||||
|
|
||||||
memset(dst, 0, len);
|
|
||||||
efi_earlycon_unmap(dst, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void efi_earlycon_scroll_up(void)
|
|
||||||
{
|
|
||||||
unsigned long *dst, *src;
|
|
||||||
u16 len;
|
|
||||||
u32 i, height;
|
|
||||||
|
|
||||||
len = screen_info.lfb_linelength;
|
|
||||||
height = screen_info.lfb_height;
|
|
||||||
|
|
||||||
for (i = 0; i < height - font->height; i++) {
|
|
||||||
dst = efi_earlycon_map(i*len, len);
|
|
||||||
if (!dst)
|
|
||||||
return;
|
|
||||||
|
|
||||||
src = efi_earlycon_map((i + font->height) * len, len);
|
|
||||||
if (!src) {
|
|
||||||
efi_earlycon_unmap(dst, len);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
memmove(dst, src, len);
|
|
||||||
|
|
||||||
efi_earlycon_unmap(src, len);
|
|
||||||
efi_earlycon_unmap(dst, len);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void efi_earlycon_write_char(u32 *dst, unsigned char c, unsigned int h)
|
|
||||||
{
|
|
||||||
const u32 color_black = 0x00000000;
|
|
||||||
const u32 color_white = 0x00ffffff;
|
|
||||||
const u8 *src;
|
|
||||||
int m, n, bytes;
|
|
||||||
u8 x;
|
|
||||||
|
|
||||||
bytes = BITS_TO_BYTES(font->width);
|
|
||||||
src = font->data + c * font->height * bytes + h * bytes;
|
|
||||||
|
|
||||||
for (m = 0; m < font->width; m++) {
|
|
||||||
n = m % 8;
|
|
||||||
x = *(src + m / 8);
|
|
||||||
if ((x >> (7 - n)) & 1)
|
|
||||||
*dst = color_white;
|
|
||||||
else
|
|
||||||
*dst = color_black;
|
|
||||||
dst++;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
|
||||||
efi_earlycon_write(struct console *con, const char *str, unsigned int num)
|
|
||||||
{
|
|
||||||
struct screen_info *si;
|
|
||||||
unsigned int len;
|
|
||||||
const char *s;
|
|
||||||
void *dst;
|
|
||||||
|
|
||||||
si = &screen_info;
|
|
||||||
len = si->lfb_linelength;
|
|
||||||
|
|
||||||
while (num) {
|
|
||||||
unsigned int linemax;
|
|
||||||
unsigned int h, count = 0;
|
|
||||||
|
|
||||||
for (s = str; *s && *s != '\n'; s++) {
|
|
||||||
if (count == num)
|
|
||||||
break;
|
|
||||||
count++;
|
|
||||||
}
|
|
||||||
|
|
||||||
linemax = (si->lfb_width - efi_x) / font->width;
|
|
||||||
if (count > linemax)
|
|
||||||
count = linemax;
|
|
||||||
|
|
||||||
for (h = 0; h < font->height; h++) {
|
|
||||||
unsigned int n, x;
|
|
||||||
|
|
||||||
dst = efi_earlycon_map((efi_y + h) * len, len);
|
|
||||||
if (!dst)
|
|
||||||
return;
|
|
||||||
|
|
||||||
s = str;
|
|
||||||
n = count;
|
|
||||||
x = efi_x;
|
|
||||||
|
|
||||||
while (n-- > 0) {
|
|
||||||
efi_earlycon_write_char(dst + x*4, *s, h);
|
|
||||||
x += font->width;
|
|
||||||
s++;
|
|
||||||
}
|
|
||||||
|
|
||||||
efi_earlycon_unmap(dst, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
num -= count;
|
|
||||||
efi_x += count * font->width;
|
|
||||||
str += count;
|
|
||||||
|
|
||||||
if (num > 0 && *s == '\n') {
|
|
||||||
efi_x = 0;
|
|
||||||
efi_y += font->height;
|
|
||||||
str++;
|
|
||||||
num--;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (efi_x + font->width > si->lfb_width) {
|
|
||||||
efi_x = 0;
|
|
||||||
efi_y += font->height;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (efi_y + font->height > si->lfb_height) {
|
|
||||||
u32 i;
|
|
||||||
|
|
||||||
efi_y -= font->height;
|
|
||||||
efi_earlycon_scroll_up();
|
|
||||||
|
|
||||||
for (i = 0; i < font->height; i++)
|
|
||||||
efi_earlycon_clear_scanline(efi_y + i);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static int __init efi_earlycon_setup(struct earlycon_device *device,
|
|
||||||
const char *opt)
|
|
||||||
{
|
|
||||||
struct screen_info *si;
|
|
||||||
u16 xres, yres;
|
|
||||||
u32 i;
|
|
||||||
|
|
||||||
if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
fb_base = screen_info.lfb_base;
|
|
||||||
if (screen_info.capabilities & VIDEO_CAPABILITY_64BIT_BASE)
|
|
||||||
fb_base |= (u64)screen_info.ext_lfb_base << 32;
|
|
||||||
|
|
||||||
fb_wb = opt && !strcmp(opt, "ram");
|
|
||||||
|
|
||||||
si = &screen_info;
|
|
||||||
xres = si->lfb_width;
|
|
||||||
yres = si->lfb_height;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* efi_earlycon_write_char() implicitly assumes a framebuffer with
|
|
||||||
* 32 bits per pixel.
|
|
||||||
*/
|
|
||||||
if (si->lfb_depth != 32)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
font = get_default_font(xres, yres, -1, -1);
|
|
||||||
if (!font)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
efi_y = rounddown(yres, font->height) - font->height;
|
|
||||||
for (i = 0; i < (yres - efi_y) / font->height; i++)
|
|
||||||
efi_earlycon_scroll_up();
|
|
||||||
|
|
||||||
device->con->write = efi_earlycon_write;
|
|
||||||
earlycon_console = device->con;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
EARLYCON_DECLARE(efifb, efi_earlycon_setup);
|
|
@ -307,6 +307,9 @@ int __init of_setup_earlycon(const struct earlycon_id *match,
|
|||||||
strscpy(early_console_dev.options, options,
|
strscpy(early_console_dev.options, options,
|
||||||
sizeof(early_console_dev.options));
|
sizeof(early_console_dev.options));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
early_console_dev.node = node;
|
||||||
|
|
||||||
earlycon_init(&early_console_dev, match->name);
|
earlycon_init(&early_console_dev, match->name);
|
||||||
err = match->setup(&early_console_dev, options);
|
err = match->setup(&early_console_dev, options);
|
||||||
earlycon_print_info(&early_console_dev);
|
earlycon_print_info(&early_console_dev);
|
||||||
|
@ -630,6 +630,17 @@ config FB_VESA
|
|||||||
You will get a boot time penguin logo at no additional cost. Please
|
You will get a boot time penguin logo at no additional cost. Please
|
||||||
read <file:Documentation/fb/vesafb.rst>. If unsure, say Y.
|
read <file:Documentation/fb/vesafb.rst>. If unsure, say Y.
|
||||||
|
|
||||||
|
config FB_EARLYCON
|
||||||
|
bool "Generic framebuffer early console"
|
||||||
|
depends on FB && SERIAL_EARLYCON && !ARM
|
||||||
|
select FONT_SUPPORT
|
||||||
|
select ARCH_USE_MEMREMAP_PROT
|
||||||
|
help
|
||||||
|
Say Y here if you want early console support for firmware established
|
||||||
|
linear framebuffer. Unless you are using EFI framebuffer, you need to
|
||||||
|
specify framebuffer geometry and address in device-tree or in kernel
|
||||||
|
command line.
|
||||||
|
|
||||||
config FB_EFI
|
config FB_EFI
|
||||||
bool "EFI-based Framebuffer Support"
|
bool "EFI-based Framebuffer Support"
|
||||||
depends on (FB = y) && !IA64 && EFI
|
depends on (FB = y) && !IA64 && EFI
|
||||||
|
@ -129,6 +129,7 @@ obj-$(CONFIG_FB_MX3) += mx3fb.o
|
|||||||
obj-$(CONFIG_FB_DA8XX) += da8xx-fb.o
|
obj-$(CONFIG_FB_DA8XX) += da8xx-fb.o
|
||||||
obj-$(CONFIG_FB_SSD1307) += ssd1307fb.o
|
obj-$(CONFIG_FB_SSD1307) += ssd1307fb.o
|
||||||
obj-$(CONFIG_FB_SIMPLE) += simplefb.o
|
obj-$(CONFIG_FB_SIMPLE) += simplefb.o
|
||||||
|
obj-$(CONFIG_FB_EARLYCON) += earlycon.o
|
||||||
|
|
||||||
# the test framebuffer is last
|
# the test framebuffer is last
|
||||||
obj-$(CONFIG_FB_VIRTUAL) += vfb.o
|
obj-$(CONFIG_FB_VIRTUAL) += vfb.o
|
||||||
|
301
drivers/video/fbdev/earlycon.c
Normal file
301
drivers/video/fbdev/earlycon.c
Normal file
@ -0,0 +1,301 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0
|
||||||
|
/*
|
||||||
|
* Copyright (C) 2013 Intel Corporation; author Matt Fleming
|
||||||
|
* Copyright (C) 2022 Markuss Broks <markuss.broks@gmail.com>
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <asm/early_ioremap.h>
|
||||||
|
#include <linux/console.h>
|
||||||
|
#include <linux/efi.h>
|
||||||
|
#include <linux/font.h>
|
||||||
|
#include <linux/io.h>
|
||||||
|
#include <linux/kernel.h>
|
||||||
|
#include <linux/mm.h>
|
||||||
|
#include <linux/of.h>
|
||||||
|
#include <linux/of_fdt.h>
|
||||||
|
#include <linux/serial_core.h>
|
||||||
|
#include <linux/screen_info.h>
|
||||||
|
|
||||||
|
struct fb_earlycon {
|
||||||
|
u32 x, y, curr_x, curr_y, depth, stride;
|
||||||
|
size_t size;
|
||||||
|
phys_addr_t phys_base;
|
||||||
|
void __iomem *virt_base;
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct console *earlycon_console __initconst;
|
||||||
|
static struct fb_earlycon info;
|
||||||
|
static const struct font_desc *font;
|
||||||
|
|
||||||
|
static int __init simplefb_earlycon_remap_fb(void)
|
||||||
|
{
|
||||||
|
int is_ram;
|
||||||
|
/* bail if there is no bootconsole or it has been disabled already */
|
||||||
|
if (!earlycon_console || !(earlycon_console->flags & CON_ENABLED))
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
is_ram = region_intersects(info.phys_base, info.size,
|
||||||
|
IORESOURCE_SYSTEM_RAM, IORES_DESC_NONE);
|
||||||
|
is_ram = is_ram == REGION_INTERSECTS;
|
||||||
|
|
||||||
|
info.virt_base = memremap(info.phys_base, info.size,
|
||||||
|
is_ram ? MEMREMAP_WB : MEMREMAP_WC);
|
||||||
|
|
||||||
|
return info.virt_base ? 0 : -ENOMEM;
|
||||||
|
}
|
||||||
|
early_initcall(simplefb_earlycon_remap_fb);
|
||||||
|
|
||||||
|
static int __init simplefb_earlycon_unmap_fb(void)
|
||||||
|
{
|
||||||
|
/* unmap the bootconsole fb unless keep_bootcon has left it enabled */
|
||||||
|
if (info.virt_base && !(earlycon_console->flags & CON_ENABLED))
|
||||||
|
memunmap(info.virt_base);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
late_initcall(simplefb_earlycon_unmap_fb);
|
||||||
|
|
||||||
|
static __ref void *simplefb_earlycon_map(unsigned long start, unsigned long len)
|
||||||
|
{
|
||||||
|
pgprot_t fb_prot;
|
||||||
|
|
||||||
|
if (info.virt_base)
|
||||||
|
return info.virt_base + start;
|
||||||
|
|
||||||
|
fb_prot = PAGE_KERNEL;
|
||||||
|
return early_memremap_prot(info.phys_base + start, len, pgprot_val(fb_prot));
|
||||||
|
}
|
||||||
|
|
||||||
|
static __ref void simplefb_earlycon_unmap(void *addr, unsigned long len)
|
||||||
|
{
|
||||||
|
if (info.virt_base)
|
||||||
|
return;
|
||||||
|
|
||||||
|
early_memunmap(addr, len);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void simplefb_earlycon_clear_scanline(unsigned int y)
|
||||||
|
{
|
||||||
|
unsigned long *dst;
|
||||||
|
u16 len;
|
||||||
|
|
||||||
|
len = info.stride;
|
||||||
|
dst = simplefb_earlycon_map(y * len, len);
|
||||||
|
if (!dst)
|
||||||
|
return;
|
||||||
|
|
||||||
|
memset(dst, 0, len);
|
||||||
|
simplefb_earlycon_unmap(dst, len);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void simplefb_earlycon_scroll_up(void)
|
||||||
|
{
|
||||||
|
unsigned long *dst, *src;
|
||||||
|
u16 len;
|
||||||
|
u32 i, height;
|
||||||
|
|
||||||
|
len = info.stride;
|
||||||
|
height = info.y;
|
||||||
|
|
||||||
|
for (i = 0; i < height - font->height; i++) {
|
||||||
|
dst = simplefb_earlycon_map(i * len, len);
|
||||||
|
if (!dst)
|
||||||
|
return;
|
||||||
|
|
||||||
|
src = simplefb_earlycon_map((i + font->height) * len, len);
|
||||||
|
if (!src) {
|
||||||
|
simplefb_earlycon_unmap(dst, len);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
memmove(dst, src, len);
|
||||||
|
|
||||||
|
simplefb_earlycon_unmap(src, len);
|
||||||
|
simplefb_earlycon_unmap(dst, len);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void simplefb_earlycon_write_char(u8 *dst, unsigned char c, unsigned int h)
|
||||||
|
{
|
||||||
|
const u8 *src;
|
||||||
|
int m, n, bytes;
|
||||||
|
u8 x;
|
||||||
|
|
||||||
|
bytes = BITS_TO_BYTES(font->width);
|
||||||
|
src = font->data + c * font->height * bytes + h * bytes;
|
||||||
|
|
||||||
|
for (m = 0; m < font->width; m++) {
|
||||||
|
n = m % 8;
|
||||||
|
x = *(src + m / 8);
|
||||||
|
if ((x >> (7 - n)) & 1)
|
||||||
|
memset(dst, 0xff, (info.depth / 8));
|
||||||
|
else
|
||||||
|
memset(dst, 0, (info.depth / 8));
|
||||||
|
dst += (info.depth / 8);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
simplefb_earlycon_write(struct console *con, const char *str, unsigned int num)
|
||||||
|
{
|
||||||
|
unsigned int len;
|
||||||
|
const char *s;
|
||||||
|
void *dst;
|
||||||
|
|
||||||
|
len = info.stride;
|
||||||
|
|
||||||
|
while (num) {
|
||||||
|
unsigned int linemax;
|
||||||
|
unsigned int h, count = 0;
|
||||||
|
|
||||||
|
for (s = str; *s && *s != '\n'; s++) {
|
||||||
|
if (count == num)
|
||||||
|
break;
|
||||||
|
count++;
|
||||||
|
}
|
||||||
|
|
||||||
|
linemax = (info.x - info.curr_x) / font->width;
|
||||||
|
if (count > linemax)
|
||||||
|
count = linemax;
|
||||||
|
|
||||||
|
for (h = 0; h < font->height; h++) {
|
||||||
|
unsigned int n, x;
|
||||||
|
|
||||||
|
dst = simplefb_earlycon_map((info.curr_y + h) * len, len);
|
||||||
|
if (!dst)
|
||||||
|
return;
|
||||||
|
|
||||||
|
s = str;
|
||||||
|
n = count;
|
||||||
|
x = info.curr_x;
|
||||||
|
|
||||||
|
while (n-- > 0) {
|
||||||
|
simplefb_earlycon_write_char(dst + (x * 4), *s, h);
|
||||||
|
x += font->width;
|
||||||
|
s++;
|
||||||
|
}
|
||||||
|
|
||||||
|
simplefb_earlycon_unmap(dst, len);
|
||||||
|
}
|
||||||
|
|
||||||
|
num -= count;
|
||||||
|
info.curr_x += count * font->width;
|
||||||
|
str += count;
|
||||||
|
|
||||||
|
if (num > 0 && *s == '\n') {
|
||||||
|
info.curr_x = 0;
|
||||||
|
info.curr_y += font->height;
|
||||||
|
str++;
|
||||||
|
num--;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (info.curr_x + font->width > info.x) {
|
||||||
|
info.curr_x = 0;
|
||||||
|
info.curr_y += font->height;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (info.curr_y + font->height > info.y) {
|
||||||
|
u32 i;
|
||||||
|
|
||||||
|
info.curr_y -= font->height;
|
||||||
|
simplefb_earlycon_scroll_up();
|
||||||
|
|
||||||
|
for (i = 0; i < font->height; i++)
|
||||||
|
simplefb_earlycon_clear_scanline(info.curr_y + i);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int __init simplefb_earlycon_setup_common(struct earlycon_device *device,
|
||||||
|
const char *opt)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
info.stride = info.x * 4;
|
||||||
|
info.size = info.x * info.y * (info.depth / 8);
|
||||||
|
|
||||||
|
font = get_default_font(info.x, info.y, -1, -1);
|
||||||
|
if (!font)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
info.curr_y = rounddown(info.y, font->height) - font->height;
|
||||||
|
for (i = 0; i < (info.y - info.curr_y) / font->height; i++)
|
||||||
|
simplefb_earlycon_scroll_up();
|
||||||
|
|
||||||
|
device->con->write = simplefb_earlycon_write;
|
||||||
|
earlycon_console = device->con;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int __init simplefb_earlycon_setup(struct earlycon_device *device,
|
||||||
|
const char *opt)
|
||||||
|
{
|
||||||
|
struct uart_port *port = &device->port;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (!port->mapbase)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
info.phys_base = port->mapbase;
|
||||||
|
|
||||||
|
ret = sscanf(device->options, "%u,%u,%u", &info.x, &info.y, &info.depth);
|
||||||
|
if (ret != 3)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
return simplefb_earlycon_setup_common(device, opt);
|
||||||
|
}
|
||||||
|
|
||||||
|
EARLYCON_DECLARE(simplefb, simplefb_earlycon_setup);
|
||||||
|
|
||||||
|
#ifdef CONFIG_EFI_EARLYCON
|
||||||
|
static int __init simplefb_earlycon_setup_efi(struct earlycon_device *device,
|
||||||
|
const char *opt)
|
||||||
|
{
|
||||||
|
if (screen_info.orig_video_isVGA != VIDEO_TYPE_EFI)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
info.phys_base = screen_info.lfb_base;
|
||||||
|
if (screen_info.capabilities & VIDEO_CAPABILITY_64BIT_BASE)
|
||||||
|
info.phys_base |= (u64)screen_info.ext_lfb_base << 32;
|
||||||
|
|
||||||
|
info.x = screen_info.lfb_width;
|
||||||
|
info.y = screen_info.lfb_height;
|
||||||
|
info.depth = screen_info.lfb_depth;
|
||||||
|
|
||||||
|
return simplefb_earlycon_setup_common(device, opt);
|
||||||
|
}
|
||||||
|
|
||||||
|
EARLYCON_DECLARE(efifb, simplefb_earlycon_setup_efi);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_OF_EARLY_FLATTREE
|
||||||
|
static int __init simplefb_earlycon_setup_of(struct earlycon_device *device,
|
||||||
|
const char *opt)
|
||||||
|
{
|
||||||
|
struct uart_port *port = &device->port;
|
||||||
|
const __be32 *val;
|
||||||
|
|
||||||
|
if (!port->mapbase)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
info.phys_base = port->mapbase;
|
||||||
|
|
||||||
|
val = of_get_flat_dt_prop(device->node, "width", NULL);
|
||||||
|
if (!val)
|
||||||
|
return -ENODEV;
|
||||||
|
info.x = be32_to_cpu(*val);
|
||||||
|
|
||||||
|
val = of_get_flat_dt_prop(device->node, "height", NULL);
|
||||||
|
if (!val)
|
||||||
|
return -ENODEV;
|
||||||
|
info.y = be32_to_cpu(*val);
|
||||||
|
|
||||||
|
val = of_get_flat_dt_prop(device->node, "stride", NULL);
|
||||||
|
if (!val)
|
||||||
|
return -ENODEV;
|
||||||
|
info.depth = (be32_to_cpu(*val) / info.x) * 8;
|
||||||
|
|
||||||
|
return simplefb_earlycon_setup_common(device, opt);
|
||||||
|
}
|
||||||
|
|
||||||
|
OF_EARLYCON_DECLARE(simplefb, "simple-framebuffer", simplefb_earlycon_setup_of);
|
||||||
|
#endif
|
@ -703,6 +703,7 @@ struct earlycon_device {
|
|||||||
struct uart_port port;
|
struct uart_port port;
|
||||||
char options[16]; /* e.g., 115200n8 */
|
char options[16]; /* e.g., 115200n8 */
|
||||||
unsigned int baud;
|
unsigned int baud;
|
||||||
|
unsigned long node;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct earlycon_id {
|
struct earlycon_id {
|
||||||
|
Loading…
Reference in New Issue
Block a user