Received: by 2002:a05:6a10:8c0a:0:0:0:0 with SMTP id go10csp240870pxb; Sat, 20 Feb 2021 01:55:45 -0800 (PST) X-Google-Smtp-Source: ABdhPJxmH84e6bXQjnN8MQb8biPc8SVajvilWuzBGDsRgCTYzPODal8bOVpAN3zOR7J51AiL2gSm X-Received: by 2002:a17:906:e0cb:: with SMTP id gl11mr286324ejb.87.1613814945342; Sat, 20 Feb 2021 01:55:45 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1613814945; cv=none; d=google.com; s=arc-20160816; b=cWa1pfXL3tWHHFvINrqVUFUpaiHgv0QzCo6flPDszbGvWvtSRhDPwGFGoYCZKHNKOJ 2wausdjounlIuFgpxEHEQV1SQ3D1Ewznrd+j5j0cO0K0v6yuHF+ANtg2XP2ilHSZnELX wIUlTj4/l6fx5ota3zdnfJaAlqSy4o7lLKYPI8oZLvgc12gZ7Sso48CINB+EoLTwfX7P mJyNgvIFiTXAI3No/Jwb2EBqPPFouH0mhLjtowqjYrI57UntsUlUDwdIHivm3854O3Nb ulztshD3NU6aPk5LtoNWsrtObk75L6MoHFRsn6+slBSwrxbH7DfvNHligKE1BMVgwHXj L4Ww== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:cc:to:subject:message-id:date:from:in-reply-to :references:mime-version:dkim-signature; bh=1WbJhgEeI46cObxhVxW5vRAg+g+yd7fwfNsmr349Wk4=; b=GUE619YWZ9nxg/KLB6WvdUb70wk0ltmAFAHIs5KSQfzVVzh/nmCK9v9MtBijY1CFum XBpSwgvRgKI1AuGAsZFSXJ+DlzogEBRmnpsQB6smDMhVWZ/PuGsSmcCIJG1MvbfBWBZK jT3Cxc4lKOy51SirJhMBLVw7WpFMQnLuvx7EmljLtIzLzj44F4CbUutbC70pQ71hTQsv rRmFH3UV3gIvY0lVrzAX40oafpVC0gJLln1wqdTI0bzgGmqRjaivD9yn0zXLNrWF9eEJ x/dKrPnD+A2ZKs6YTs3DACJnbEuOh4awnK01hWMVTYWWIJyo5FVmsWXN4ryPCTOz9OUd DrLQ== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@kernel.org header.s=k20201202 header.b=oxjrJCkJ; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id h18si8454722eds.493.2021.02.20.01.55.22; Sat, 20 Feb 2021 01:55:45 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; dkim=pass header.i=@kernel.org header.s=k20201202 header.b=oxjrJCkJ; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S229696AbhBTJyB (ORCPT + 99 others); Sat, 20 Feb 2021 04:54:01 -0500 Received: from mail.kernel.org ([198.145.29.99]:41868 "EHLO mail.kernel.org" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229476AbhBTJx7 (ORCPT ); Sat, 20 Feb 2021 04:53:59 -0500 Received: by mail.kernel.org (Postfix) with ESMTPSA id C287964ED2 for ; Sat, 20 Feb 2021 09:53:16 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=kernel.org; s=k20201202; t=1613814796; bh=LvUCv0jQt9FESwiFZcl6mYSdh2+JOpazwepM96jBIjo=; h=References:In-Reply-To:From:Date:Subject:To:Cc:From; b=oxjrJCkJIadAy/b9b9N+Ca+lM8fvF/0eB+P6g5OElNy01rvVWdSIaE9bIt8YXN7rp utUCZ+PiJcWoLTiP0RE4P2RMyJcJaZZQ8GD2nWUTs5/yFjpCwcMDX0fHQ78i0Ajp5X zCbRRUmAsXsLn/49b3TR8y6cfLLbKbFn9MK0Vk/B6FmWV0Hximp3SoZrwrNjrJUI9R xvHoUUFLbbxKDp149amNMeTJli2k6UpGez++dPB86YRNfWONn2hcRDlqE5JdGgvnNQ CbjioCIPvmDDr0/1L5dS7yMMxmWDgCkBwt03tU5YCKK39QTT9QoHcTUAI6THGsuZQI Q5KsskcKVUN8w== Received: by mail-il1-f180.google.com with SMTP id q9so6645632ilo.1 for ; Sat, 20 Feb 2021 01:53:16 -0800 (PST) X-Gm-Message-State: AOAM533hq0zGr5Mfuy9CA1KtqKGFyaR5XFgFZuYppjsSJ+v0Ugs1MW7R QbpOfd6MzALy0WeO3i9PduQtyQ5CRvkprU5dlIs= X-Received: by 2002:a05:6e02:b2c:: with SMTP id e12mr7254664ilu.143.1613814795937; Sat, 20 Feb 2021 01:53:15 -0800 (PST) MIME-Version: 1.0 References: <20210219091146.75364-1-lichenyang@loongson.cn> In-Reply-To: <20210219091146.75364-1-lichenyang@loongson.cn> From: Huacai Chen Date: Sat, 20 Feb 2021 17:53:03 +0800 X-Gmail-Original-Message-ID: Message-ID: Subject: Re: [PATCH v5] drm/loongson: Add DRM Driver for Loongson 7A1000 bridge chip To: Chenyang Li Cc: Maarten Lankhorst , Maxime Ripard , Thomas Zimmermann , David Airlie , Daniel Vetter , LKML , Maling list - DRI developers , Huacai Chen , Tiezhu Yang Content-Type: text/plain; charset="UTF-8" Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi, Chenyang, On Fri, Feb 19, 2021 at 5:11 PM Chenyang Li wrote: > > This patch adds an initial DRM driver for the Loongson LS7A1000 > bridge chip(LS7A). The LS7A bridge chip contains two display > controllers, support dual display output. The maximum support for > each channel display is to 1920x1080@60Hz. > At present, DC device detection and DRM driver registration are > completed, the crtc/plane/encoder/connector objects has been > implemented. > On Loongson 3A4000 CPU and 7A1000 system, we have achieved the use > of dual screen, and support dual screen clone mode and expansion > mode. > > v5: > - Change the name of the chip to LS7A. > - Change magic value in crtc to macros. > - Correct mistakes words. > - Change the register operation function prefix to ls7a. > > v4: > - Move the mode_valid function to the crtc. > > v3: > - Move the mode_valid function to the connector and optimize it. > - Fix num_crtc calculation method. > > v2: > - Complete the case of 32-bit color in CRTC. > > Signed-off-by: Chenyang Li > --- > drivers/gpu/drm/Kconfig | 2 + > drivers/gpu/drm/Makefile | 1 + > drivers/gpu/drm/loongson/Kconfig | 14 + > drivers/gpu/drm/loongson/Makefile | 14 + > drivers/gpu/drm/loongson/loongson_connector.c | 48 ++++ > drivers/gpu/drm/loongson/loongson_crtc.c | 243 ++++++++++++++++ > drivers/gpu/drm/loongson/loongson_device.c | 54 ++++ > drivers/gpu/drm/loongson/loongson_drv.c | 269 ++++++++++++++++++ > drivers/gpu/drm/loongson/loongson_drv.h | 140 +++++++++ > drivers/gpu/drm/loongson/loongson_encoder.c | 37 +++ > drivers/gpu/drm/loongson/loongson_plane.c | 102 +++++++ > 11 files changed, 924 insertions(+) > create mode 100644 drivers/gpu/drm/loongson/Kconfig > create mode 100644 drivers/gpu/drm/loongson/Makefile > create mode 100644 drivers/gpu/drm/loongson/loongson_connector.c > create mode 100644 drivers/gpu/drm/loongson/loongson_crtc.c > create mode 100644 drivers/gpu/drm/loongson/loongson_device.c > create mode 100644 drivers/gpu/drm/loongson/loongson_drv.c > create mode 100644 drivers/gpu/drm/loongson/loongson_drv.h > create mode 100644 drivers/gpu/drm/loongson/loongson_encoder.c > create mode 100644 drivers/gpu/drm/loongson/loongson_plane.c > > diff --git a/drivers/gpu/drm/Kconfig b/drivers/gpu/drm/Kconfig > index 0973f408d75f..6ed1b6dc2f25 100644 > --- a/drivers/gpu/drm/Kconfig > +++ b/drivers/gpu/drm/Kconfig > @@ -374,6 +374,8 @@ source "drivers/gpu/drm/xen/Kconfig" > > source "drivers/gpu/drm/vboxvideo/Kconfig" > > +source "drivers/gpu/drm/loongson/Kconfig" > + > source "drivers/gpu/drm/lima/Kconfig" > > source "drivers/gpu/drm/panfrost/Kconfig" > diff --git a/drivers/gpu/drm/Makefile b/drivers/gpu/drm/Makefile > index fefaff4c832d..f87da730ea6d 100644 > --- a/drivers/gpu/drm/Makefile > +++ b/drivers/gpu/drm/Makefile > @@ -119,6 +119,7 @@ obj-$(CONFIG_DRM_PL111) += pl111/ > obj-$(CONFIG_DRM_TVE200) += tve200/ > obj-$(CONFIG_DRM_XEN) += xen/ > obj-$(CONFIG_DRM_VBOXVIDEO) += vboxvideo/ > +obj-$(CONFIG_DRM_LOONGSON) += loongson/ > obj-$(CONFIG_DRM_LIMA) += lima/ > obj-$(CONFIG_DRM_PANFROST) += panfrost/ > obj-$(CONFIG_DRM_ASPEED_GFX) += aspeed/ > diff --git a/drivers/gpu/drm/loongson/Kconfig b/drivers/gpu/drm/loongson/Kconfig > new file mode 100644 > index 000000000000..3cf42a4cca08 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/Kconfig > @@ -0,0 +1,14 @@ > +# SPDX-License-Identifier: GPL-2.0-only > + > +config DRM_LOONGSON > + tristate "DRM support for LS7A bridge chipset" > + depends on DRM && PCI > + depends on CPU_LOONGSON64 > + select DRM_KMS_HELPER > + select DRM_VRAM_HELPER > + select DRM_TTM > + select DRM_TTM_HELPER > + default n > + help > + Support the display controllers found on the Loongson LS7A > + bridge. > diff --git a/drivers/gpu/drm/loongson/Makefile b/drivers/gpu/drm/loongson/Makefile > new file mode 100644 > index 000000000000..22d063953b78 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/Makefile > @@ -0,0 +1,14 @@ > +# SPDX-License-Identifier: GPL-2.0-only > +# > +# Makefile for loongson drm drivers. > +# This driver provides support for the > +# Direct Rendering Infrastructure (DRI) > + > +ccflags-y := -Iinclude/drm > +loongson-y := loongson_drv.o \ > + loongson_crtc.o \ > + loongson_plane.o \ > + loongson_device.o \ > + loongson_connector.o \ > + loongson_encoder.o > +obj-$(CONFIG_DRM_LOONGSON) += loongson.o > diff --git a/drivers/gpu/drm/loongson/loongson_connector.c b/drivers/gpu/drm/loongson/loongson_connector.c > new file mode 100644 > index 000000000000..6b1f0ffa33bd > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_connector.c > @@ -0,0 +1,48 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > + > +#include "loongson_drv.h" > + > +static int loongson_get_modes(struct drm_connector *connector) > +{ > + int count; > + > + count = drm_add_modes_noedid(connector, 1920, 1080); > + drm_set_preferred_mode(connector, 1024, 768); > + > + return count; > +} > + > +static const struct drm_connector_helper_funcs loongson_connector_helper = { > + .get_modes = loongson_get_modes, > +}; > + > +static const struct drm_connector_funcs loongson_connector_funcs = { > + .fill_modes = drm_helper_probe_single_connector_modes, > + .destroy = drm_connector_cleanup, > + .reset = drm_atomic_helper_connector_reset, > + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, > + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, > +}; > + > +int loongson_connector_init(struct loongson_device *ldev, int index) > +{ > + struct drm_connector *connector; > + struct loongson_connector *lconnector; > + > + lconnector = kzalloc(sizeof(struct loongson_connector), GFP_KERNEL); > + if (!lconnector) { > + DRM_INFO("loongson connector kzalloc failed\n"); > + return -1; > + } > + > + lconnector->ldev = ldev; > + lconnector->id = index; > + > + ldev->mode_info[index].connector = lconnector; > + connector = &lconnector->base; > + drm_connector_init(ldev->dev, connector, &loongson_connector_funcs, > + DRM_MODE_CONNECTOR_Unknown); > + drm_connector_helper_add(connector, &loongson_connector_helper); > + > + return 0; > +} > diff --git a/drivers/gpu/drm/loongson/loongson_crtc.c b/drivers/gpu/drm/loongson/loongson_crtc.c > new file mode 100644 > index 000000000000..85227bc8b288 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_crtc.c > @@ -0,0 +1,243 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > + > +#include "loongson_drv.h" > + > +static void try_each_loopc(u32 clk, u32 pstdiv, u32 frefc, > + struct pix_pll *pll_config) > +{ > + u32 loopc; > + u32 clk_out; > + u32 precision; > + u32 min = 1000; > + u32 base_clk = 100000L; > + > + for (loopc = LOOPC_MIN; loopc < LOOPC_MAX; loopc++) { > + if ((loopc < FRE_REF_MIN * frefc) || > + (loopc > FRE_REF_MAX * frefc)) > + continue; > + > + clk_out = base_clk * loopc / frefc; > + precision = (clk > clk_out) ? (clk - clk_out) : (clk_out - clk); > + if (precision < min) { > + pll_config->l2_div = pstdiv; > + pll_config->l1_loopc = loopc; > + pll_config->l1_frefc = frefc; > + } > + } > +} > + > +static void cal_freq(u32 pixclock, struct pix_pll *pll_config) > +{ > + u32 pstdiv; > + u32 frefc; > + u32 clk; > + > + for (pstdiv = 1; pstdiv < PST_DIV_MAX; pstdiv++) { > + clk = pixclock * pstdiv; > + for (frefc = DIV_REF_MIN; frefc <= DIV_REF_MAX; frefc++) > + try_each_loopc(clk, pstdiv, frefc, pll_config); > + } > +} > + > +static void config_pll(struct loongson_device *ldev, unsigned long pll_base, > + struct pix_pll *pll_cfg) > +{ > + u32 val; > + u32 count = 0; > + > + /* clear sel_pll_out0 */ > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val &= ~(1UL << 8); > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > + > + /* set pll_pd */ > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val |= (1UL << 13); > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > + > + /* clear set_pll_param */ > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val &= ~(1UL << 11); > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > + > + /* clear old value & config new value */ > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val &= ~(0x7fUL << 0); > + val |= (pll_cfg->l1_frefc << 0); /* refc */ > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > + val = ls7a_io_rreg(ldev, pll_base + 0x0); > + val &= ~(0x7fUL << 0); > + val |= (pll_cfg->l2_div << 0); /* div */ > + val &= ~(0x1ffUL << 21); > + val |= (pll_cfg->l1_loopc << 21); /* loopc */ > + ls7a_io_wreg(ldev, pll_base + 0x0, val); > + > + /* set set_pll_param */ > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val |= (1UL << 11); > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > + /* clear pll_pd */ > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val &= ~(1UL << 13); > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > + > + while (!(ls7a_io_rreg(ldev, pll_base + 0x4) & 0x80)) { > + cpu_relax(); > + count++; > + if (count >= 1000) { > + DRM_ERROR("loongson-7A PLL lock failed\n"); > + break; > + } > + } > + > + val = ls7a_io_rreg(ldev, pll_base + 0x4); > + val |= (1UL << 8); > + ls7a_io_wreg(ldev, pll_base + 0x4, val); > +} > + > +static void loongson_crtc_mode_set_nofb(struct drm_crtc *crtc) > +{ > + struct drm_device *dev = crtc->dev; > + struct loongson_device *ldev = dev->dev_private; > + struct loongson_crtc *lcrtc = to_loongson_crtc(crtc); > + struct drm_display_mode *mode = &crtc->state->adjusted_mode; > + const struct drm_format_info *format; > + struct pix_pll pll_cfg; > + u32 hr, hss, hse, hfl; > + u32 vr, vss, vse, vfl; > + u32 pix_freq; > + u32 reg_offset; > + > + hr = mode->hdisplay; > + hss = mode->hsync_start; > + hse = mode->hsync_end; > + hfl = mode->htotal; > + > + vr = mode->vdisplay; > + vss = mode->vsync_start; > + vse = mode->vsync_end; > + vfl = mode->vtotal; > + > + pix_freq = mode->clock; > + reg_offset = lcrtc->reg_offset; > + format = crtc->primary->state->fb->format; > + > + ls7a_mm_wreg_locked(ldev, FB_DITCFG_REG + reg_offset, 0); > + ls7a_mm_wreg_locked(ldev, FB_DITTAB_LO_REG + reg_offset, 0); > + ls7a_mm_wreg_locked(ldev, FB_DITTAB_HI_REG + reg_offset, 0); > + ls7a_mm_wreg_locked(ldev, FB_PANCFG_REG + reg_offset, FB_PANCFG_DEF); > + ls7a_mm_wreg_locked(ldev, FB_PANTIM_REG + reg_offset, 0); > + > + ls7a_mm_wreg_locked(ldev, FB_HDISPLAY_REG + reg_offset, (hfl << 16) | hr); > + ls7a_mm_wreg_locked(ldev, FB_HSYNC_REG + reg_offset, > + FB_HSYNC_PULSE | (hse << 16) | hss); > + > + ls7a_mm_wreg_locked(ldev, FB_VDISPLAY_REG + reg_offset, (vfl << 16) | vr); > + ls7a_mm_wreg_locked(ldev, FB_VSYNC_REG + reg_offset, > + FB_VSYNC_PULSE | (vse << 16) | vss); > + > + switch (format->format) { > + case DRM_FORMAT_RGB565: > + lcrtc->cfg_reg |= 0x3; > + break; > + case DRM_FORMAT_RGB888: > + case DRM_FORMAT_XRGB8888: > + case DRM_FORMAT_ARGB8888: > + default: > + lcrtc->cfg_reg |= 0x4; > + break; > + } > + ls7a_mm_wreg_locked(ldev, FB_CFG_REG + reg_offset, lcrtc->cfg_reg); > + > + cal_freq(pix_freq, &pll_cfg); > + config_pll(ldev, LS7A_PIX_PLL + reg_offset, &pll_cfg); > +} > + > +static void loongson_crtc_atomic_enable(struct drm_crtc *crtc, > + struct drm_crtc_state *old_state) > +{ > + struct drm_device *dev = crtc->dev; > + struct loongson_device *ldev = dev->dev_private; > + struct loongson_crtc *lcrtc = to_loongson_crtc(crtc); > + u32 reg_offset = lcrtc->reg_offset; > + > + lcrtc->cfg_reg |= CFG_ENABLE; > + ls7a_mm_wreg_locked(ldev, FB_CFG_REG + reg_offset, lcrtc->cfg_reg); > +} > + > +static void loongson_crtc_atomic_disable(struct drm_crtc *crtc, > + struct drm_crtc_state *old_state) > +{ > + struct drm_device *dev = crtc->dev; > + struct loongson_device *ldev = dev->dev_private; > + struct loongson_crtc *lcrtc = to_loongson_crtc(crtc); > + u32 reg_offset = lcrtc->reg_offset; > + > + lcrtc->cfg_reg &= ~CFG_ENABLE; > + ls7a_mm_wreg_locked(ldev, FB_CFG_REG + reg_offset, lcrtc->cfg_reg); > +} > + > +static enum drm_mode_status loongson_mode_valid(struct drm_crtc *crtc, > + struct drm_display_mode *mode) > +{ > + if (mode->hdisplay > 1920) > + return MODE_BAD; > + if (mode->vdisplay > 1080) > + return MODE_BAD; > + if (mode->hdisplay % 64) > + return MODE_BAD; > + if (mode->clock > 173000) > + return MODE_CLOCK_HIGH; > + > + return MODE_OK; > +} > + > +static const struct drm_crtc_helper_funcs loongson_crtc_helper_funcs = { > + .mode_valid = loongson_mode_valid, > + .atomic_enable = loongson_crtc_atomic_enable, > + .atomic_disable = loongson_crtc_atomic_disable, > + .mode_set_nofb = loongson_crtc_mode_set_nofb, > +}; > + > +static const struct drm_crtc_funcs loongson_crtc_funcs = { > + .set_config = drm_atomic_helper_set_config, > + .page_flip = drm_atomic_helper_page_flip, > + .reset = drm_atomic_helper_crtc_reset, > + .destroy = drm_crtc_cleanup, > + .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state, > + .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state, > +}; > + > +int loongson_crtc_init(struct loongson_device *ldev, int index) > +{ > + struct loongson_crtc *lcrtc; > + u32 ret; > + > + lcrtc = kzalloc(sizeof(struct loongson_crtc), GFP_KERNEL); > + if (lcrtc == NULL) > + return -1; > + > + lcrtc->ldev = ldev; > + lcrtc->reg_offset = index * REG_OFFSET; > + lcrtc->cfg_reg = CFG_RESET; > + lcrtc->crtc_id = index; > + > + ret = loongson_plane_init(lcrtc); > + if (ret) > + return ret; > + > + ret = drm_crtc_init_with_planes(ldev->dev, &lcrtc->base, lcrtc->plane, > + NULL, &loongson_crtc_funcs, NULL); > + if (ret) { > + DRM_ERROR("failed to init crtc %d\n", index); > + drm_plane_cleanup(lcrtc->plane); > + return ret; > + } > + > + drm_crtc_helper_add(&lcrtc->base, &loongson_crtc_helper_funcs); > + > + ldev->mode_info[index].crtc = lcrtc; > + > + return 0; > +} > + > diff --git a/drivers/gpu/drm/loongson/loongson_device.c b/drivers/gpu/drm/loongson/loongson_device.c > new file mode 100644 > index 000000000000..072bd3070731 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_device.c > @@ -0,0 +1,54 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > + > +#include "loongson_drv.h" > + > +u32 loongson_gpu_offset(struct drm_plane_state *state) > +{ > + struct drm_gem_vram_object *gbo; > + struct loongson_crtc *lcrtc; > + struct loongson_device *ldev; > + u32 gpu_addr; > + > + lcrtc = to_loongson_crtc(state->crtc); > + ldev = lcrtc->ldev; > + > + gbo = drm_gem_vram_of_gem(state->fb->obj[0]); > + gpu_addr = ldev->vram_start + drm_gem_vram_offset(gbo); > + > + return gpu_addr; > +} > + > +u32 ls7a_io_rreg(struct loongson_device *ldev, u32 offset) > +{ > + u32 val; > + > + val = readl(ldev->io + offset); > + > + return val; > +} > + > +void ls7a_io_wreg(struct loongson_device *ldev, u32 offset, u32 val) > +{ > + writel(val, ldev->io + offset); > +} > + > +u32 ls7a_mm_rreg_locked(struct loongson_device *ldev, u32 offset) > +{ > + u32 val; > + unsigned long flags; > + > + spin_lock_irqsave(&ldev->mmio_lock, flags); > + val = readl(ldev->mmio + offset); > + spin_unlock_irqrestore(&ldev->mmio_lock, flags); > + > + return val; > +} > + > +void ls7a_mm_wreg_locked(struct loongson_device *ldev, u32 offset, u32 val) > +{ > + unsigned long flags; > + > + spin_lock_irqsave(&ldev->mmio_lock, flags); > + writel(val, ldev->mmio + offset); > + spin_unlock_irqrestore(&ldev->mmio_lock, flags); > +} Why lock and disable irq? To workaround the hw issue from the first revision of LS7A? If so, I suggest to remove the workaround. Because: 1, mmio r/w will be used in irq context; 2, newer revision of LS7A doesn't need workaround. > diff --git a/drivers/gpu/drm/loongson/loongson_drv.c b/drivers/gpu/drm/loongson/loongson_drv.c > new file mode 100644 > index 000000000000..14b2ea5d6784 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_drv.c > @@ -0,0 +1,269 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > +/* > + * Loongson LS7A1000 bridge chipset drm driver > + */ > + > +#include > +#include > +#include > +#include > +#include "loongson_drv.h" > + > +/* Interface history: > + * 0.1 - original. > + */ > +#define DRIVER_MAJOR 0 > +#define DRIVER_MINOR 1 > + > +static const struct drm_mode_config_funcs loongson_mode_funcs = { > + .fb_create = drm_gem_fb_create, > + .atomic_check = drm_atomic_helper_check, > + .atomic_commit = drm_atomic_helper_commit, > + .output_poll_changed = drm_fb_helper_output_poll_changed, > + .mode_valid = drm_vram_helper_mode_valid > +}; > + > +static int loongson_device_init(struct drm_device *dev, uint32_t flags) > +{ > + struct loongson_device *ldev = dev->dev_private; > + struct pci_dev *gpu_pdev; > + resource_size_t aper_base; > + resource_size_t aper_size; > + resource_size_t mmio_base; > + resource_size_t mmio_size; > + > + /* GPU MEM */ > + /* We need get 7A-gpu pci device information for ldev->gpu_pdev */ > + /* dev->pdev save 7A-dc pci device information */ > + gpu_pdev = pci_get_device(PCI_VENDOR_ID_LOONGSON, > + PCI_DEVICE_ID_LOONGSON_GPU, NULL); > + if (IS_ERR(gpu_pdev)) > + return PTR_ERR(gpu_pdev); > + > + ldev->gpu_pdev = gpu_pdev; > + aper_base = pci_resource_start(gpu_pdev, 2); > + aper_size = pci_resource_len(gpu_pdev, 2); > + ldev->vram_start = (u32)aper_base; > + ldev->vram_size = (u32)aper_size; > + > + if (!devm_request_mem_region(ldev->dev->dev, ldev->vram_start, > + ldev->vram_size, "loongson_vram")) { > + DRM_ERROR("Can't reserve VRAM\n"); > + return -ENXIO; > + } > + > + /* DC MEM */ > + mmio_base = pci_resource_start(ldev->dev->pdev, 0); > + mmio_size = pci_resource_len(ldev->dev->pdev, 0); > + ldev->mmio = devm_ioremap(dev->dev, mmio_base, mmio_size); > + if (!ldev->mmio) { > + drm_err(dev, "Cannot map mmio region\n"); > + return -ENOMEM; > + } > + > + if (!devm_request_mem_region(ldev->dev->dev, mmio_base, > + mmio_size, "loongson_mmio")) { > + DRM_ERROR("Can't reserve mmio registers\n"); > + return -ENOMEM; > + } > + > + /* DC IO */ > + ldev->io = (void *)TO_UNCAC(LS7A_CHIPCFG_REG_BASE); TO_UNCAC() is a MIPS-specific macro, I think ioremap() is better. > + if (ldev->io == NULL) > + return -ENOMEM; > + > + DRM_INFO("DC mmio_base 0x%llx mmio_size 0x%llx io 0x%x\n", > + mmio_base, mmio_size, *(int *)ldev->io); > + DRM_INFO("GPU vram_start = 0x%x vram_size = 0x%x\n", > + ldev->vram_start, ldev->vram_size); > + > + return 0; > +} > + > +int loongson_modeset_init(struct loongson_device *ldev) > +{ > + struct drm_encoder *encoder; > + struct drm_connector *connector; > + int i; > + u32 ret; > + > + ldev->dev->mode_config.allow_fb_modifiers = true; > + > + for (i = 0; i < 2; i++) { > + ret = loongson_crtc_init(ldev, i); > + if (ret) { > + DRM_WARN("loongson crtc%d init failed\n", i); > + continue; > + } > + > + ret = loongson_encoder_init(ldev, i); > + if (ret) { > + DRM_ERROR("loongson_encoder_init failed\n"); > + return -1; > + } > + > + ret = loongson_connector_init(ldev, i); > + if (ret) { > + DRM_ERROR("loongson_connector_init failed\n"); > + return -1; > + } > + > + encoder = &ldev->mode_info[i].encoder->base; > + connector = &ldev->mode_info[i].connector->base; > + drm_connector_attach_encoder(connector, encoder); > + ldev->num_crtc++; > + } > + > + return 0; > +} > + > +static int loongson_drm_load(struct drm_device *dev, unsigned long flags) > +{ > + struct loongson_device *ldev; > + int ret; > + > + ldev = devm_kzalloc(dev->dev, sizeof(*ldev), GFP_KERNEL); > + if (!ldev) > + return -ENOMEM; > + > + dev->dev_private = ldev; > + ldev->dev = dev; > + > + ret = loongson_device_init(dev, flags); > + if (ret) > + goto err; > + > + ret = drmm_vram_helper_init(dev, ldev->vram_start, ldev->vram_size); > + if (ret) > + goto err; > + > + drm_mode_config_init(dev); > + dev->mode_config.funcs = (void *)&loongson_mode_funcs; > + dev->mode_config.min_width = 1; > + dev->mode_config.min_height = 1; > + dev->mode_config.max_width = 4096; > + dev->mode_config.max_height = 4096; > + dev->mode_config.preferred_depth = 32; > + dev->mode_config.prefer_shadow = 1; > + dev->mode_config.fb_base = ldev->vram_start; > + > + pci_set_drvdata(dev->pdev, dev); > + > + ret = loongson_modeset_init(ldev); > + if (ret) > + dev_err(dev->dev, "Fatal error during modeset init: %d\n", ret); > + > + drm_kms_helper_poll_init(dev); > + drm_mode_config_reset(dev); > + > + return 0; > + > +err: > + drm_err(dev, "failed to initialize drm driver: %d\n", ret); > + return ret; > +} > + > +static void loongson_drm_unload(struct drm_device *dev) > +{ > + drm_vram_helper_release_mm(dev); > + drm_mode_config_cleanup(dev); > + dev->dev_private = NULL; > + dev_set_drvdata(dev->dev, NULL); > +} > + > +DEFINE_DRM_GEM_FOPS(fops); > + > +static struct drm_driver loongson_drm_driver = { > + .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC, > + .fops = &fops, > + DRM_GEM_VRAM_DRIVER, > + > + .name = DRIVER_NAME, > + .desc = DRIVER_DESC, > + .date = DRIVER_DATE, > + .major = DRIVER_MAJOR, > + .minor = DRIVER_MINOR, > +}; > + > +static int loongson_pci_probe(struct pci_dev *pdev, > + const struct pci_device_id *ent) > +{ > + int ret; > + struct drm_device *dev; > + > + dev = drm_dev_alloc(&loongson_drm_driver, &pdev->dev); > + if (IS_ERR(dev)) { > + DRM_ERROR("failed to allocate drm_device\n"); > + return PTR_ERR(dev); > + } > + > + dev->pdev = pdev; > + pci_set_drvdata(pdev, dev); > + > + ret = pci_enable_device(pdev); > + if (ret) { > + drm_err(dev, "failed to enable pci device: %d\n", ret); > + goto err_free; > + } > + > + ret = loongson_drm_load(dev, 0x0); > + if (ret) { > + drm_err(dev, "failed to load loongson: %d\n", ret); > + goto err_pdev; > + } > + > + ret = drm_dev_register(dev, 0); > + if (ret) { > + drm_err(dev, "failed to register drv for userspace access: %d\n", > + ret); > + goto err_pdev; > + } > + > + drm_fbdev_generic_setup(dev, dev->mode_config.preferred_depth); > + > + return 0; > + > +err_pdev: > + pci_disable_device(pdev); > +err_free: > + drm_dev_put(dev); > + return ret; > +} > + > +static void loongson_pci_remove(struct pci_dev *pdev) > +{ > + struct drm_device *dev = pci_get_drvdata(pdev); > + > + drm_dev_unregister(dev); > + loongson_drm_unload(dev); > + drm_dev_put(dev); > +} > + > +static struct pci_device_id loongson_pci_devices[] = { > + { PCI_DEVICE(PCI_VENDOR_ID_LOONGSON, PCI_DEVICE_ID_LOONGSON_DC) }, > + {0,} > +}; > + > +static struct pci_driver loongson_drm_pci_driver = { > + .name = DRIVER_NAME, > + .id_table = loongson_pci_devices, > + .probe = loongson_pci_probe, > + .remove = loongson_pci_remove, > +}; > + > +static int __init loongson_drm_init(void) > +{ > + return pci_register_driver(&loongson_drm_pci_driver); > +} > + > +static void __exit loongson_drm_exit(void) > +{ > + pci_unregister_driver(&loongson_drm_pci_driver); > +} > + > +module_init(loongson_drm_init); > +module_exit(loongson_drm_exit); > + > +MODULE_AUTHOR(DRIVER_AUTHOR); > +MODULE_DESCRIPTION(DRIVER_DESC); > +MODULE_LICENSE("GPL v2"); > diff --git a/drivers/gpu/drm/loongson/loongson_drv.h b/drivers/gpu/drm/loongson/loongson_drv.h > new file mode 100644 > index 000000000000..9d0c05280a18 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_drv.h > @@ -0,0 +1,140 @@ > +/* SPDX-License-Identifier: GPL-2.0-only */ > + > +#ifndef __LOONGSON_DRV_H__ > +#define __LOONGSON_DRV_H__ > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +/* General customization: > + */ > +#define DRIVER_AUTHOR "Loongson graphics driver team" > +#define DRIVER_NAME "loongson-drm" > +#define DRIVER_DESC "Loongson LS7A DRM driver" > +#define DRIVER_DATE "20200915" > + > +#define to_loongson_crtc(x) container_of(x, struct loongson_crtc, base) > +#define to_loongson_encoder(x) container_of(x, struct loongson_encoder, base) > + > +#define LS7A_CHIPCFG_REG_BASE (0x10010000) > +#define PCI_DEVICE_ID_LOONGSON_DC 0x7a06 > +#define PCI_DEVICE_ID_LOONGSON_GPU 0x7a15 They are already defined in include/linux/pci_ids.h. > +#define LS7A_PIX_PLL (0x04b0) > +#define REG_OFFSET (0x10) > +#define FB_CFG_REG (0x1240) > +#define FB_ADDR0_REG (0x1260) > +#define FB_ADDR1_REG (0x1580) > +#define FB_STRI_REG (0x1280) > +#define FB_DITCFG_REG (0x1360) > +#define FB_DITTAB_LO_REG (0x1380) > +#define FB_DITTAB_HI_REG (0x13a0) > +#define FB_PANCFG_REG (0x13c0) > +#define FB_PANTIM_REG (0x13e0) > +#define FB_HDISPLAY_REG (0x1400) > +#define FB_HSYNC_REG (0x1420) > +#define FB_VDISPLAY_REG (0x1480) > +#define FB_VSYNC_REG (0x14a0) > + > +#define CFG_FMT GENMASK(2, 0) > +#define CFG_FBSWITCH BIT(7) > +#define CFG_ENABLE BIT(8) > +#define CFG_FBNUM BIT(11) > +#define CFG_GAMMAR BIT(12) > +#define CFG_RESET BIT(20) > + > +#define FB_PANCFG_DEF 0x80001311 > +#define FB_HSYNC_PULSE (1 << 30) > +#define FB_VSYNC_PULSE (1 << 30) > + > +/* PIX PLL */ > +#define LOOPC_MIN 24 > +#define LOOPC_MAX 161 > +#define FRE_REF_MIN 12 > +#define FRE_REF_MAX 32 > +#define DIV_REF_MIN 3 > +#define DIV_REF_MAX 5 > +#define PST_DIV_MAX 64 > + > +struct pix_pll { > + u32 l2_div; > + u32 l1_loopc; > + u32 l1_frefc; > +}; > + > +struct loongson_crtc { > + struct drm_crtc base; > + struct loongson_device *ldev; > + u32 crtc_id; > + u32 reg_offset; > + u32 cfg_reg; > + struct drm_plane *plane; > +}; > + > +struct loongson_encoder { > + struct drm_encoder base; > + struct loongson_device *ldev; > + struct loongson_crtc *lcrtc; > +}; > + > +struct loongson_connector { > + struct drm_connector base; > + struct loongson_device *ldev; > + u16 id; > + u32 type; > +}; > + > +struct loongson_mode_info { > + struct loongson_device *ldev; > + struct loongson_crtc *crtc; > + struct loongson_encoder *encoder; > + struct loongson_connector *connector; > +}; > + > +struct loongson_device { > + struct drm_device *dev; > + struct drm_atomic_state *state; > + > + spinlock_t mmio_lock; > + void __iomem *mmio; > + void __iomem *io; > + u32 vram_start; > + u32 vram_size; > + > + u32 num_crtc; > + struct loongson_mode_info mode_info[2]; > + struct pci_dev *gpu_pdev; /* LS7A gpu device info */ > +}; > + > +/* crtc */ > +int loongson_crtc_init(struct loongson_device *ldev, int index); > + > +/* connector */ > +int loongson_connector_init(struct loongson_device *ldev, int index); > + > +/* encoder */ > +int loongson_encoder_init(struct loongson_device *ldev, int index); > + > +/* plane */ > +int loongson_plane_init(struct loongson_crtc *lcrtc); > + > +/* device */ > +u32 loongson_gpu_offset(struct drm_plane_state *state); > +u32 ls7a_mm_rreg_locked(struct loongson_device *ldev, u32 offset); > +void ls7a_mm_wreg_locked(struct loongson_device *ldev, u32 offset, u32 val); > +u32 ls7a_io_rreg(struct loongson_device *ldev, u32 offset); > +void ls7a_io_wreg(struct loongson_device *ldev, u32 offset, u32 val); > + > +#endif /* __LOONGSON_DRV_H__ */ > diff --git a/drivers/gpu/drm/loongson/loongson_encoder.c b/drivers/gpu/drm/loongson/loongson_encoder.c > new file mode 100644 > index 000000000000..2002cee00303 > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_encoder.c > @@ -0,0 +1,37 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > + > +#include "loongson_drv.h" > + > +static void loongson_encoder_destroy(struct drm_encoder *encoder) > +{ > + struct loongson_encoder *lencoder = to_loongson_encoder(encoder); > + > + drm_encoder_cleanup(encoder); > + kfree(lencoder); > +} > + > +static const struct drm_encoder_funcs loongson_encoder_funcs = { > + .destroy = loongson_encoder_destroy, > +}; > + > +int loongson_encoder_init(struct loongson_device *ldev, int index) > +{ > + struct drm_encoder *encoder; > + struct loongson_encoder *lencoder; > + > + lencoder = kzalloc(sizeof(struct loongson_encoder), GFP_KERNEL); > + if (!lencoder) > + return -1; > + > + lencoder->lcrtc = ldev->mode_info[index].crtc; > + lencoder->ldev = ldev; > + encoder = &lencoder->base; > + encoder->possible_crtcs = 1 << index; > + > + drm_encoder_init(ldev->dev, encoder, &loongson_encoder_funcs, > + DRM_MODE_ENCODER_DAC, NULL); > + > + ldev->mode_info[index].encoder = lencoder; > + > + return 0; > +} > diff --git a/drivers/gpu/drm/loongson/loongson_plane.c b/drivers/gpu/drm/loongson/loongson_plane.c > new file mode 100644 > index 000000000000..8be999a443be > --- /dev/null > +++ b/drivers/gpu/drm/loongson/loongson_plane.c > @@ -0,0 +1,102 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > + > +#include "loongson_drv.h" > + > +static void loongson_plane_atomic_update(struct drm_plane *plane, > + struct drm_plane_state *old_state) > +{ > + struct loongson_crtc *lcrtc; > + struct loongson_device *ldev; > + struct drm_plane_state *state = plane->state; > + u32 gpu_addr = 0; > + u32 fb_addr = 0; > + u32 reg_val = 0; > + u32 reg_offset; > + u32 pitch; > + u8 depth; > + u32 x, y; > + > + if (!state->crtc || !state->fb) > + return; > + > + pitch = state->fb->pitches[0]; > + lcrtc = to_loongson_crtc(state->crtc); > + ldev = lcrtc->ldev; > + reg_offset = lcrtc->reg_offset; > + x = state->crtc->x; > + y = state->crtc->y; > + depth = state->fb->format->cpp[0] << 3; > + > + gpu_addr = loongson_gpu_offset(state); > + reg_val = (pitch + 255) & ~255; > + ls7a_mm_wreg_locked(ldev, FB_STRI_REG + reg_offset, reg_val); > + > + switch (depth) { > + case 12 ... 16: > + fb_addr = gpu_addr + y * pitch + ALIGN(x, 64) * 2; > + break; > + case 24 ... 32: > + default: > + fb_addr = gpu_addr + y * pitch + ALIGN(x, 64) * 4; > + break; > + } > + > + ls7a_mm_wreg_locked(ldev, FB_ADDR0_REG + reg_offset, fb_addr); > + ls7a_mm_wreg_locked(ldev, FB_ADDR1_REG + reg_offset, fb_addr); > + reg_val = lcrtc->cfg_reg | CFG_ENABLE; > + ls7a_mm_wreg_locked(ldev, FB_CFG_REG + reg_offset, reg_val); > +} > + > +static const uint32_t loongson_formats[] = { > + DRM_FORMAT_RGB565, > + DRM_FORMAT_RGB888, > + DRM_FORMAT_XRGB8888, > + DRM_FORMAT_ARGB8888, > +}; > + > +static const uint64_t loongson_format_modifiers[] = { DRM_FORMAT_MOD_LINEAR, > + DRM_FORMAT_MOD_INVALID }; > + > +static const struct drm_plane_funcs loongson_plane_funcs = { > + .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state, > + .atomic_destroy_state = drm_atomic_helper_plane_destroy_state, > + .destroy = drm_plane_cleanup, > + .disable_plane = drm_atomic_helper_disable_plane, > + .reset = drm_atomic_helper_plane_reset, > + .update_plane = drm_atomic_helper_update_plane, > +}; > + > +static const struct drm_plane_helper_funcs loongson_plane_helper_funcs = { > + .prepare_fb = drm_gem_vram_plane_helper_prepare_fb, > + .cleanup_fb = drm_gem_vram_plane_helper_cleanup_fb, > + .atomic_update = loongson_plane_atomic_update, > +}; > + > +int loongson_plane_init(struct loongson_crtc *lcrtc) > +{ > + struct loongson_device *ldev; > + int crtc_id; > + int ret; > + > + ldev = lcrtc->ldev; > + crtc_id = lcrtc->crtc_id; > + > + lcrtc->plane = devm_kzalloc(ldev->dev->dev, sizeof(*lcrtc->plane), > + GFP_KERNEL); > + if (!lcrtc->plane) > + return -ENOMEM; > + > + ret = drm_universal_plane_init(ldev->dev, lcrtc->plane, BIT(crtc_id), > + &loongson_plane_funcs, loongson_formats, > + ARRAY_SIZE(loongson_formats), > + loongson_format_modifiers, > + DRM_PLANE_TYPE_PRIMARY, NULL); > + if (ret) { > + DRM_ERROR("fail to init planed crtc %d\n", crtc_id); > + return ret; > + } > + > + drm_plane_helper_add(lcrtc->plane, &loongson_plane_helper_funcs); > + > + return 0; > +} > -- > 2.30.0 >