1 /**************************************************************************
2 * Copyright (c) 2011, Intel Corporation.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18 **************************************************************************/
20 #include <linux/backlight.h>
26 #include "psb_intel_reg.h"
27 #include "intel_bios.h"
30 static int psb_output_init(struct drm_device *dev)
32 struct drm_psb_private *dev_priv = dev->dev_private;
33 psb_intel_lvds_init(dev, &dev_priv->mode_dev);
34 psb_intel_sdvo_init(dev, SDVOB);
38 #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE
41 * Poulsbo Backlight Interfaces
44 #define BLC_PWM_PRECISION_FACTOR 100 /* 10000000 */
45 #define BLC_PWM_FREQ_CALC_CONSTANT 32
48 #define PSB_BLC_PWM_PRECISION_FACTOR 10
49 #define PSB_BLC_MAX_PWM_REG_FREQ 0xFFFE
50 #define PSB_BLC_MIN_PWM_REG_FREQ 0x2
52 #define PSB_BACKLIGHT_PWM_POLARITY_BIT_CLEAR (0xFFFE)
53 #define PSB_BACKLIGHT_PWM_CTL_SHIFT (16)
55 static int psb_brightness;
56 static struct backlight_device *psb_backlight_device;
58 static int psb_get_brightness(struct backlight_device *bd)
60 /* return locally cached var instead of HW read (due to DPST etc.) */
61 /* FIXME: ideally return actual value in case firmware fiddled with
63 return psb_brightness;
67 static int psb_backlight_setup(struct drm_device *dev)
69 struct drm_psb_private *dev_priv = dev->dev_private;
70 unsigned long core_clock;
71 /* u32 bl_max_freq; */
72 /* unsigned long value; */
75 uint32_t blc_pwm_precision_factor;
77 /* get bl_max_freq and pol from dev_priv*/
78 if (!dev_priv->lvds_bl) {
79 dev_err(dev->dev, "Has no valid LVDS backlight info\n");
82 bl_max_freq = dev_priv->lvds_bl->freq;
83 blc_pwm_precision_factor = PSB_BLC_PWM_PRECISION_FACTOR;
85 core_clock = dev_priv->core_freq;
87 value = (core_clock * MHz) / BLC_PWM_FREQ_CALC_CONSTANT;
88 value *= blc_pwm_precision_factor;
90 value /= blc_pwm_precision_factor;
92 if (value > (unsigned long long)PSB_BLC_MAX_PWM_REG_FREQ ||
93 value < (unsigned long long)PSB_BLC_MIN_PWM_REG_FREQ)
96 value &= PSB_BACKLIGHT_PWM_POLARITY_BIT_CLEAR;
97 REG_WRITE(BLC_PWM_CTL,
98 (value << PSB_BACKLIGHT_PWM_CTL_SHIFT) | (value));
103 static int psb_set_brightness(struct backlight_device *bd)
105 struct drm_device *dev = bl_get_data(psb_backlight_device);
106 int level = bd->props.brightness;
108 /* Percentage 1-100% being valid */
112 psb_intel_lvds_set_brightness(dev, level);
113 psb_brightness = level;
117 static const struct backlight_ops psb_ops = {
118 .get_brightness = psb_get_brightness,
119 .update_status = psb_set_brightness,
122 static int psb_backlight_init(struct drm_device *dev)
124 struct drm_psb_private *dev_priv = dev->dev_private;
126 struct backlight_properties props;
128 memset(&props, 0, sizeof(struct backlight_properties));
129 props.max_brightness = 100;
130 props.type = BACKLIGHT_PLATFORM;
132 psb_backlight_device = backlight_device_register("psb-bl",
133 NULL, (void *)dev, &psb_ops, &props);
134 if (IS_ERR(psb_backlight_device))
135 return PTR_ERR(psb_backlight_device);
137 ret = psb_backlight_setup(dev);
139 backlight_device_unregister(psb_backlight_device);
140 psb_backlight_device = NULL;
143 psb_backlight_device->props.brightness = 100;
144 psb_backlight_device->props.max_brightness = 100;
145 backlight_update_status(psb_backlight_device);
146 dev_priv->backlight_device = psb_backlight_device;
153 * Provide the Poulsbo specific chip logic and low level methods
154 * for power management
157 static void psb_init_pm(struct drm_device *dev)
159 struct drm_psb_private *dev_priv = dev->dev_private;
161 u32 gating = PSB_RSGX32(PSB_CR_CLKGATECTL);
162 gating &= ~3; /* Disable 2D clock gating */
164 PSB_WSGX32(gating, PSB_CR_CLKGATECTL);
165 PSB_RSGX32(PSB_CR_CLKGATECTL);
169 * psb_save_display_registers - save registers lost on suspend
170 * @dev: our DRM device
172 * Save the state we need in order to be able to restore the interface
173 * upon resume from suspend
175 static int psb_save_display_registers(struct drm_device *dev)
177 struct drm_psb_private *dev_priv = dev->dev_private;
178 struct drm_crtc *crtc;
179 struct drm_connector *connector;
180 struct psb_state *regs = &dev_priv->regs;
182 /* Display arbitration control + watermarks */
183 regs->saveDSPARB = PSB_RVDC32(DSPARB);
184 regs->saveDSPFW1 = PSB_RVDC32(DSPFW1);
185 regs->saveDSPFW2 = PSB_RVDC32(DSPFW2);
186 regs->saveDSPFW3 = PSB_RVDC32(DSPFW3);
187 regs->saveDSPFW4 = PSB_RVDC32(DSPFW4);
188 regs->saveDSPFW5 = PSB_RVDC32(DSPFW5);
189 regs->saveDSPFW6 = PSB_RVDC32(DSPFW6);
190 regs->saveCHICKENBIT = PSB_RVDC32(DSPCHICKENBIT);
192 /* Save crtc and output state */
193 mutex_lock(&dev->mode_config.mutex);
194 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
195 if (drm_helper_crtc_in_use(crtc))
196 crtc->funcs->save(crtc);
199 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
200 connector->funcs->save(connector);
202 mutex_unlock(&dev->mode_config.mutex);
207 * psb_restore_display_registers - restore lost register state
208 * @dev: our DRM device
210 * Restore register state that was lost during suspend and resume.
212 static int psb_restore_display_registers(struct drm_device *dev)
214 struct drm_psb_private *dev_priv = dev->dev_private;
215 struct drm_crtc *crtc;
216 struct drm_connector *connector;
217 struct psb_state *regs = &dev_priv->regs;
219 /* Display arbitration + watermarks */
220 PSB_WVDC32(regs->saveDSPARB, DSPARB);
221 PSB_WVDC32(regs->saveDSPFW1, DSPFW1);
222 PSB_WVDC32(regs->saveDSPFW2, DSPFW2);
223 PSB_WVDC32(regs->saveDSPFW3, DSPFW3);
224 PSB_WVDC32(regs->saveDSPFW4, DSPFW4);
225 PSB_WVDC32(regs->saveDSPFW5, DSPFW5);
226 PSB_WVDC32(regs->saveDSPFW6, DSPFW6);
227 PSB_WVDC32(regs->saveCHICKENBIT, DSPCHICKENBIT);
229 /*make sure VGA plane is off. it initializes to on after reset!*/
230 PSB_WVDC32(0x80000000, VGACNTRL);
232 mutex_lock(&dev->mode_config.mutex);
233 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head)
234 if (drm_helper_crtc_in_use(crtc))
235 crtc->funcs->restore(crtc);
237 list_for_each_entry(connector, &dev->mode_config.connector_list, head)
238 connector->funcs->restore(connector);
240 mutex_unlock(&dev->mode_config.mutex);
244 static int psb_power_down(struct drm_device *dev)
249 static int psb_power_up(struct drm_device *dev)
254 static void psb_get_core_freq(struct drm_device *dev)
257 struct pci_dev *pci_root = pci_get_bus_and_slot(0, 0);
258 struct drm_psb_private *dev_priv = dev->dev_private;
260 /*pci_write_config_dword(pci_root, 0xD4, 0x00C32004);*/
261 /*pci_write_config_dword(pci_root, 0xD0, 0xE0033000);*/
263 pci_write_config_dword(pci_root, 0xD0, 0xD0050300);
264 pci_read_config_dword(pci_root, 0xD4, &clock);
265 pci_dev_put(pci_root);
267 switch (clock & 0x07) {
269 dev_priv->core_freq = 100;
272 dev_priv->core_freq = 133;
275 dev_priv->core_freq = 150;
278 dev_priv->core_freq = 178;
281 dev_priv->core_freq = 200;
286 dev_priv->core_freq = 266;
288 dev_priv->core_freq = 0;
292 static int psb_chip_setup(struct drm_device *dev)
294 psb_get_core_freq(dev);
295 gma_intel_setup_gmbus(dev);
296 gma_intel_opregion_init(dev);
297 psb_intel_init_bios(dev);
301 static void psb_chip_teardown(struct drm_device *dev)
303 gma_intel_teardown_gmbus(dev);
306 const struct psb_ops psb_chip_ops = {
311 .sgx_offset = PSB_SGX_OFFSET,
312 .chip_setup = psb_chip_setup,
313 .chip_teardown = psb_chip_teardown,
315 .crtc_helper = &psb_intel_helper_funcs,
316 .crtc_funcs = &psb_intel_crtc_funcs,
318 .output_init = psb_output_init,
320 #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE
321 .backlight_init = psb_backlight_init,
324 .init_pm = psb_init_pm,
325 .save_regs = psb_save_display_registers,
326 .restore_regs = psb_restore_display_registers,
327 .power_down = psb_power_down,
328 .power_up = psb_power_up,