From patchwork Wed Mar 2 11:49:23 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Woody Lin X-Patchwork-Id: 12765872 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id C3267C433FE for ; Wed, 2 Mar 2022 11:49:45 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S234246AbiCBLu1 (ORCPT ); Wed, 2 Mar 2022 06:50:27 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:48412 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S241595AbiCBLu0 (ORCPT ); Wed, 2 Mar 2022 06:50:26 -0500 Received: from mail-pj1-x104a.google.com (mail-pj1-x104a.google.com [IPv6:2607:f8b0:4864:20::104a]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 3AB45B3E74 for ; Wed, 2 Mar 2022 03:49:41 -0800 (PST) Received: by mail-pj1-x104a.google.com with SMTP id ds4-20020a17090b08c400b001bc1dee733eso2125213pjb.0 for ; Wed, 02 Mar 2022 03:49:41 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=20210112; h=date:message-id:mime-version:subject:from:to:cc; bh=d8Le9zjXLTZJ+dCcHcXMiX4PKgrIUfbKBFSNaT4aJ2w=; b=PqRZKdx/ZIHo22zRMv/XRRfiBCD45pWfFJSP3z5DrY/wrv/KtrvRL5HfxR5sENwPYz uL2lKGp6OBIbqLcp8G0NyxK4SPAkkPKXvHXp28cTEunJh2kabzQi2Hr6hOsay14tz6NC JM82YWY4QoaFAk03psAExHx8Ama6xUAchr0rBJyy0HbuxedHQjJP7QX660Uly83eJT50 m0mgCn7m4ZtGFZc2j2hOzaSj2y+lEDdvyBXl35P0rIG4i6uEQ3r0cUQJD1R0d6HU5l2F gjBiuhD/gtXXv99FTZVz8UPYP3oo+C4A9QyLRUSF4KaLi2DanuxZqv6YFXbBjUUoW/1c rQaw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=x-gm-message-state:date:message-id:mime-version:subject:from:to:cc; bh=d8Le9zjXLTZJ+dCcHcXMiX4PKgrIUfbKBFSNaT4aJ2w=; b=HjDmiq/hgmfoEJE2jUZwJpnphGHr2LTZTcwe2lOf8SsMz1n+UlhW6KQm26jacllJCH FAaRoaPjtn/SBDmr2lJ0qoDS+v4N49Odp9FTM0I7GrMuSimDzGfITov/XlgStVQxRkSk rZ+k7p57PEW2ugU+SmYfiiBD3LRp02732v30gmzlZ9l9j/L5yL6sGnZmHnmKa1TGJ/eq nYKJ6gvcKLsRIY7P0mql3SRsEPjfpmgJ2YZX7TCEahSstiHNdwVoCSezGoTdTdAkGf2f UvU7d3QMoD+FCtTrwmkyVaMdYYL3NN0oYBJIwKWeuvlAD2t5Jszlrc5NjnTDT1zRiv8s Y3SA== X-Gm-Message-State: AOAM5305pjLL7YIQg0qOzujomxnM2pGJ0pF5MEKrL6ARUTTN7gTNP94M DhU0/bk+pVFkIEgzwlA5QsCQv9eFj+KIKg== X-Google-Smtp-Source: ABdhPJyFbde461Cotj6o6U7pY+L7SCINXBc+8oYRbBDI7yWBVpv1h2/5q5mXlKhGaSmiOZviZye58OpK8JE9dA== X-Received: from woodylin.ntc.corp.google.com ([2401:fa00:fc:202:7e73:baee:4e7:d626]) (user=woodylin job=sendgmr) by 2002:a17:902:7c94:b0:14d:77d2:a72e with SMTP id y20-20020a1709027c9400b0014d77d2a72emr31145588pll.153.1646221780681; Wed, 02 Mar 2022 03:49:40 -0800 (PST) Date: Wed, 2 Mar 2022 19:49:23 +0800 Message-Id: <20220302114923.144523-1-woodylin@google.com> Mime-Version: 1.0 X-Mailer: git-send-email 2.35.1.574.g5d30c73bfb-goog Subject: [PATCH v2] serial: samsung: Add samsung_early_read to support early kgdboc From: Woody Lin To: Krzysztof Kozlowski , Alim Akhtar Cc: Greg Kroah-Hartman , Jiri Slaby , linux-samsung-soc@vger.kernel.org, linux-serial@vger.kernel.org, linux-kernel@vger.kernel.org, woodylin@google.com, markcheng@google.com Precedence: bulk List-ID: X-Mailing-List: linux-samsung-soc@vger.kernel.org The 'kgdboc_earlycon_init' looks for boot console that has both .read and .write callbacks. Adds 'samsung_early_read' to samsung_tty.c's early console to support kgdboc. Signed-off-by: Woody Lin Reviewed-by: Krzysztof Kozlowski --- v2: add 'const' to 'struct samsung_early_console_data *data' --- drivers/tty/serial/samsung_tty.c | 25 +++++++++++++++++++++++++ 1 file changed, 25 insertions(+) diff --git a/drivers/tty/serial/samsung_tty.c b/drivers/tty/serial/samsung_tty.c index d002a4e48ed9..12233c2d2a44 100644 --- a/drivers/tty/serial/samsung_tty.c +++ b/drivers/tty/serial/samsung_tty.c @@ -2949,6 +2949,7 @@ static void wr_reg_barrier(struct uart_port *port, u32 reg, u32 val) struct samsung_early_console_data { u32 txfull_mask; + u32 rxfifo_mask; }; static void samsung_early_busyuart(struct uart_port *port) @@ -2983,6 +2984,26 @@ static void samsung_early_write(struct console *con, const char *s, uart_console_write(&dev->port, s, n, samsung_early_putc); } +static int samsung_early_read(struct console *con, char *s, unsigned int n) +{ + struct earlycon_device *dev = con->data; + const struct samsung_early_console_data *data = dev->port.private_data; + int ch, ufstat, num_read = 0; + + while (num_read < n) { + ufstat = rd_regl(&dev->port, S3C2410_UFSTAT); + if (!(ufstat & data->rxfifo_mask)) + break; + ch = rd_reg(&dev->port, S3C2410_URXH); + if (ch == NO_POLL_CHAR) + break; + + s[num_read++] = ch; + } + + return num_read; +} + static int __init samsung_early_console_setup(struct earlycon_device *device, const char *opt) { @@ -2990,12 +3011,14 @@ static int __init samsung_early_console_setup(struct earlycon_device *device, return -ENODEV; device->con->write = samsung_early_write; + device->con->read = samsung_early_read; return 0; } /* S3C2410 */ static struct samsung_early_console_data s3c2410_early_console_data = { .txfull_mask = S3C2410_UFSTAT_TXFULL, + .rxfifo_mask = S3C2410_UFSTAT_RXFULL | S3C2410_UFSTAT_RXMASK, }; static int __init s3c2410_early_console_setup(struct earlycon_device *device, @@ -3011,6 +3034,7 @@ OF_EARLYCON_DECLARE(s3c2410, "samsung,s3c2410-uart", /* S3C2412, S3C2440, S3C64xx */ static struct samsung_early_console_data s3c2440_early_console_data = { .txfull_mask = S3C2440_UFSTAT_TXFULL, + .rxfifo_mask = S3C2440_UFSTAT_RXFULL | S3C2440_UFSTAT_RXMASK, }; static int __init s3c2440_early_console_setup(struct earlycon_device *device, @@ -3030,6 +3054,7 @@ OF_EARLYCON_DECLARE(s3c6400, "samsung,s3c6400-uart", /* S5PV210, Exynos */ static struct samsung_early_console_data s5pv210_early_console_data = { .txfull_mask = S5PV210_UFSTAT_TXFULL, + .rxfifo_mask = S5PV210_UFSTAT_RXFULL | S5PV210_UFSTAT_RXMASK, }; static int __init s5pv210_early_console_setup(struct earlycon_device *device,