// SPDX-License-Identifier: GPL-2.0-only /************************************************************************** * Copyright (c) 2011, Intel Corporation. * All Rights Reserved. * **************************************************************************/ #include #include #include "gma_device.h" #include "intel_bios.h" #include "psb_device.h" #include "psb_drv.h" #include "psb_intel_reg.h" #include "psb_reg.h" static int psb_output_init(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); psb_intel_lvds_init(dev, &dev_priv->mode_dev); psb_intel_sdvo_init(dev, SDVOB); return 0; } #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE /* * Poulsbo Backlight Interfaces */ #define BLC_PWM_PRECISION_FACTOR 100 /* 10000000 */ #define BLC_PWM_FREQ_CALC_CONSTANT 32 #define MHz 1000000 #define PSB_BLC_PWM_PRECISION_FACTOR 10 #define PSB_BLC_MAX_PWM_REG_FREQ 0xFFFE #define PSB_BLC_MIN_PWM_REG_FREQ 0x2 #define PSB_BACKLIGHT_PWM_POLARITY_BIT_CLEAR (0xFFFE) #define PSB_BACKLIGHT_PWM_CTL_SHIFT (16) static int psb_brightness; static struct backlight_device *psb_backlight_device; static int psb_get_brightness(struct backlight_device *bd) { /* return locally cached var instead of HW read (due to DPST etc.) */ /* FIXME: ideally return actual value in case firmware fiddled with it */ return psb_brightness; } static int psb_backlight_setup(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); unsigned long core_clock; /* u32 bl_max_freq; */ /* unsigned long value; */ u16 bl_max_freq; uint32_t value; uint32_t blc_pwm_precision_factor; /* get bl_max_freq and pol from dev_priv*/ if (!dev_priv->lvds_bl) { dev_err(dev->dev, "Has no valid LVDS backlight info\n"); return -ENOENT; } bl_max_freq = dev_priv->lvds_bl->freq; blc_pwm_precision_factor = PSB_BLC_PWM_PRECISION_FACTOR; core_clock = dev_priv->core_freq; value = (core_clock * MHz) / BLC_PWM_FREQ_CALC_CONSTANT; value *= blc_pwm_precision_factor; value /= bl_max_freq; value /= blc_pwm_precision_factor; if (value > (unsigned long long)PSB_BLC_MAX_PWM_REG_FREQ || value < (unsigned long long)PSB_BLC_MIN_PWM_REG_FREQ) return -ERANGE; else { value &= PSB_BACKLIGHT_PWM_POLARITY_BIT_CLEAR; REG_WRITE(BLC_PWM_CTL, (value << PSB_BACKLIGHT_PWM_CTL_SHIFT) | (value)); } return 0; } static int psb_set_brightness(struct backlight_device *bd) { struct drm_device *dev = bl_get_data(psb_backlight_device); int level = bd->props.brightness; /* Percentage 1-100% being valid */ if (level < 1) level = 1; psb_intel_lvds_set_brightness(dev, level); psb_brightness = level; return 0; } static const struct backlight_ops psb_ops = { .get_brightness = psb_get_brightness, .update_status = psb_set_brightness, }; static int psb_backlight_init(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); int ret; struct backlight_properties props; memset(&props, 0, sizeof(struct backlight_properties)); props.max_brightness = 100; props.type = BACKLIGHT_PLATFORM; psb_backlight_device = backlight_device_register("psb-bl", NULL, (void *)dev, &psb_ops, &props); if (IS_ERR(psb_backlight_device)) return PTR_ERR(psb_backlight_device); ret = psb_backlight_setup(dev); if (ret < 0) { backlight_device_unregister(psb_backlight_device); psb_backlight_device = NULL; return ret; } psb_backlight_device->props.brightness = 100; psb_backlight_device->props.max_brightness = 100; backlight_update_status(psb_backlight_device); dev_priv->backlight_device = psb_backlight_device; /* This must occur after the backlight is properly initialised */ psb_lid_timer_init(dev_priv); return 0; } #endif /* * Provide the Poulsbo specific chip logic and low level methods * for power management */ static void psb_init_pm(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); u32 gating = PSB_RSGX32(PSB_CR_CLKGATECTL); gating &= ~3; /* Disable 2D clock gating */ gating |= 1; PSB_WSGX32(gating, PSB_CR_CLKGATECTL); PSB_RSGX32(PSB_CR_CLKGATECTL); } /** * psb_save_display_registers - save registers lost on suspend * @dev: our DRM device * * Save the state we need in order to be able to restore the interface * upon resume from suspend */ static int psb_save_display_registers(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); struct drm_crtc *crtc; struct gma_connector *connector; struct psb_state *regs = &dev_priv->regs.psb; /* Display arbitration control + watermarks */ regs->saveDSPARB = PSB_RVDC32(DSPARB); regs->saveDSPFW1 = PSB_RVDC32(DSPFW1); regs->saveDSPFW2 = PSB_RVDC32(DSPFW2); regs->saveDSPFW3 = PSB_RVDC32(DSPFW3); regs->saveDSPFW4 = PSB_RVDC32(DSPFW4); regs->saveDSPFW5 = PSB_RVDC32(DSPFW5); regs->saveDSPFW6 = PSB_RVDC32(DSPFW6); regs->saveCHICKENBIT = PSB_RVDC32(DSPCHICKENBIT); /* Save crtc and output state */ drm_modeset_lock_all(dev); list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) { if (drm_helper_crtc_in_use(crtc)) dev_priv->ops->save_crtc(crtc); } list_for_each_entry(connector, &dev->mode_config.connector_list, base.head) if (connector->save) connector->save(&connector->base); drm_modeset_unlock_all(dev); return 0; } /** * psb_restore_display_registers - restore lost register state * @dev: our DRM device * * Restore register state that was lost during suspend and resume. */ static int psb_restore_display_registers(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); struct drm_crtc *crtc; struct gma_connector *connector; struct psb_state *regs = &dev_priv->regs.psb; /* Display arbitration + watermarks */ PSB_WVDC32(regs->saveDSPARB, DSPARB); PSB_WVDC32(regs->saveDSPFW1, DSPFW1); PSB_WVDC32(regs->saveDSPFW2, DSPFW2); PSB_WVDC32(regs->saveDSPFW3, DSPFW3); PSB_WVDC32(regs->saveDSPFW4, DSPFW4); PSB_WVDC32(regs->saveDSPFW5, DSPFW5); PSB_WVDC32(regs->saveDSPFW6, DSPFW6); PSB_WVDC32(regs->saveCHICKENBIT, DSPCHICKENBIT); /*make sure VGA plane is off. it initializes to on after reset!*/ PSB_WVDC32(0x80000000, VGACNTRL); drm_modeset_lock_all(dev); list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) if (drm_helper_crtc_in_use(crtc)) dev_priv->ops->restore_crtc(crtc); list_for_each_entry(connector, &dev->mode_config.connector_list, base.head) if (connector->restore) connector->restore(&connector->base); drm_modeset_unlock_all(dev); return 0; } static int psb_power_down(struct drm_device *dev) { return 0; } static int psb_power_up(struct drm_device *dev) { return 0; } /* Poulsbo */ static const struct psb_offset psb_regmap[2] = { { .fp0 = FPA0, .fp1 = FPA1, .cntr = DSPACNTR, .conf = PIPEACONF, .src = PIPEASRC, .dpll = DPLL_A, .htotal = HTOTAL_A, .hblank = HBLANK_A, .hsync = HSYNC_A, .vtotal = VTOTAL_A, .vblank = VBLANK_A, .vsync = VSYNC_A, .stride = DSPASTRIDE, .size = DSPASIZE, .pos = DSPAPOS, .base = DSPABASE, .surf = DSPASURF, .addr = DSPABASE, .status = PIPEASTAT, .linoff = DSPALINOFF, .tileoff = DSPATILEOFF, .palette = PALETTE_A, }, { .fp0 = FPB0, .fp1 = FPB1, .cntr = DSPBCNTR, .conf = PIPEBCONF, .src = PIPEBSRC, .dpll = DPLL_B, .htotal = HTOTAL_B, .hblank = HBLANK_B, .hsync = HSYNC_B, .vtotal = VTOTAL_B, .vblank = VBLANK_B, .vsync = VSYNC_B, .stride = DSPBSTRIDE, .size = DSPBSIZE, .pos = DSPBPOS, .base = DSPBBASE, .surf = DSPBSURF, .addr = DSPBBASE, .status = PIPEBSTAT, .linoff = DSPBLINOFF, .tileoff = DSPBTILEOFF, .palette = PALETTE_B, } }; static int psb_chip_setup(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); dev_priv->regmap = psb_regmap; gma_get_core_freq(dev); gma_intel_setup_gmbus(dev); psb_intel_opregion_init(dev); psb_intel_init_bios(dev); return 0; } static void psb_chip_teardown(struct drm_device *dev) { struct drm_psb_private *dev_priv = to_drm_psb_private(dev); psb_lid_timer_takedown(dev_priv); gma_intel_teardown_gmbus(dev); } const struct psb_ops psb_chip_ops = { .name = "Poulsbo", .pipes = 2, .crtcs = 2, .hdmi_mask = (1 << 0), .lvds_mask = (1 << 1), .sdvo_mask = (1 << 0), .cursor_needs_phys = 1, .sgx_offset = PSB_SGX_OFFSET, .chip_setup = psb_chip_setup, .chip_teardown = psb_chip_teardown, .crtc_helper = &psb_intel_helper_funcs, .crtc_funcs = &gma_intel_crtc_funcs, .clock_funcs = &psb_clock_funcs, .output_init = psb_output_init, #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE .backlight_init = psb_backlight_init, #endif .init_pm = psb_init_pm, .save_regs = psb_save_display_registers, .restore_regs = psb_restore_display_registers, .save_crtc = gma_crtc_save, .restore_crtc = gma_crtc_restore, .power_down = psb_power_down, .power_up = psb_power_up, };