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>
23 #include <drm/gma_drm.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
;
148 /* This must occur after the backlight is properly initialised */
149 psb_lid_timer_init(dev_priv
);
157 * Provide the Poulsbo specific chip logic and low level methods
158 * for power management
161 static void psb_init_pm(struct drm_device
*dev
)
163 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
165 u32 gating
= PSB_RSGX32(PSB_CR_CLKGATECTL
);
166 gating
&= ~3; /* Disable 2D clock gating */
168 PSB_WSGX32(gating
, PSB_CR_CLKGATECTL
);
169 PSB_RSGX32(PSB_CR_CLKGATECTL
);
173 * psb_save_display_registers - save registers lost on suspend
174 * @dev: our DRM device
176 * Save the state we need in order to be able to restore the interface
177 * upon resume from suspend
179 static int psb_save_display_registers(struct drm_device
*dev
)
181 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
182 struct drm_crtc
*crtc
;
183 struct drm_connector
*connector
;
184 struct psb_state
*regs
= &dev_priv
->regs
.psb
;
186 /* Display arbitration control + watermarks */
187 regs
->saveDSPARB
= PSB_RVDC32(DSPARB
);
188 regs
->saveDSPFW1
= PSB_RVDC32(DSPFW1
);
189 regs
->saveDSPFW2
= PSB_RVDC32(DSPFW2
);
190 regs
->saveDSPFW3
= PSB_RVDC32(DSPFW3
);
191 regs
->saveDSPFW4
= PSB_RVDC32(DSPFW4
);
192 regs
->saveDSPFW5
= PSB_RVDC32(DSPFW5
);
193 regs
->saveDSPFW6
= PSB_RVDC32(DSPFW6
);
194 regs
->saveCHICKENBIT
= PSB_RVDC32(DSPCHICKENBIT
);
196 /* Save crtc and output state */
197 mutex_lock(&dev
->mode_config
.mutex
);
198 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
) {
199 if (drm_helper_crtc_in_use(crtc
))
200 crtc
->funcs
->save(crtc
);
203 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
)
204 if (connector
->funcs
->save
)
205 connector
->funcs
->save(connector
);
207 mutex_unlock(&dev
->mode_config
.mutex
);
212 * psb_restore_display_registers - restore lost register state
213 * @dev: our DRM device
215 * Restore register state that was lost during suspend and resume.
217 static int psb_restore_display_registers(struct drm_device
*dev
)
219 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
220 struct drm_crtc
*crtc
;
221 struct drm_connector
*connector
;
222 struct psb_state
*regs
= &dev_priv
->regs
.psb
;
224 /* Display arbitration + watermarks */
225 PSB_WVDC32(regs
->saveDSPARB
, DSPARB
);
226 PSB_WVDC32(regs
->saveDSPFW1
, DSPFW1
);
227 PSB_WVDC32(regs
->saveDSPFW2
, DSPFW2
);
228 PSB_WVDC32(regs
->saveDSPFW3
, DSPFW3
);
229 PSB_WVDC32(regs
->saveDSPFW4
, DSPFW4
);
230 PSB_WVDC32(regs
->saveDSPFW5
, DSPFW5
);
231 PSB_WVDC32(regs
->saveDSPFW6
, DSPFW6
);
232 PSB_WVDC32(regs
->saveCHICKENBIT
, DSPCHICKENBIT
);
234 /*make sure VGA plane is off. it initializes to on after reset!*/
235 PSB_WVDC32(0x80000000, VGACNTRL
);
237 mutex_lock(&dev
->mode_config
.mutex
);
238 list_for_each_entry(crtc
, &dev
->mode_config
.crtc_list
, head
)
239 if (drm_helper_crtc_in_use(crtc
))
240 crtc
->funcs
->restore(crtc
);
242 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
, head
)
243 if (connector
->funcs
->restore
)
244 connector
->funcs
->restore(connector
);
246 mutex_unlock(&dev
->mode_config
.mutex
);
250 static int psb_power_down(struct drm_device
*dev
)
255 static int psb_power_up(struct drm_device
*dev
)
260 static void psb_get_core_freq(struct drm_device
*dev
)
263 struct pci_dev
*pci_root
= pci_get_bus_and_slot(0, 0);
264 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
266 /*pci_write_config_dword(pci_root, 0xD4, 0x00C32004);*/
267 /*pci_write_config_dword(pci_root, 0xD0, 0xE0033000);*/
269 pci_write_config_dword(pci_root
, 0xD0, 0xD0050300);
270 pci_read_config_dword(pci_root
, 0xD4, &clock
);
271 pci_dev_put(pci_root
);
273 switch (clock
& 0x07) {
275 dev_priv
->core_freq
= 100;
278 dev_priv
->core_freq
= 133;
281 dev_priv
->core_freq
= 150;
284 dev_priv
->core_freq
= 178;
287 dev_priv
->core_freq
= 200;
292 dev_priv
->core_freq
= 266;
295 dev_priv
->core_freq
= 0;
300 static const struct psb_offset psb_regmap
[2] = {
314 .stride
= DSPASTRIDE
,
321 .linoff
= DSPALINOFF
,
322 .tileoff
= DSPATILEOFF
,
323 .palette
= PALETTE_A
,
338 .stride
= DSPBSTRIDE
,
345 .linoff
= DSPBLINOFF
,
346 .tileoff
= DSPBTILEOFF
,
347 .palette
= PALETTE_B
,
351 static int psb_chip_setup(struct drm_device
*dev
)
353 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
354 dev_priv
->regmap
= psb_regmap
;
355 psb_get_core_freq(dev
);
356 gma_intel_setup_gmbus(dev
);
357 psb_intel_opregion_init(dev
);
358 psb_intel_init_bios(dev
);
362 static void psb_chip_teardown(struct drm_device
*dev
)
364 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
365 psb_lid_timer_takedown(dev_priv
);
366 gma_intel_teardown_gmbus(dev
);
369 const struct psb_ops psb_chip_ops
= {
374 .hdmi_mask
= (1 << 0),
375 .lvds_mask
= (1 << 1),
376 .cursor_needs_phys
= 1,
377 .sgx_offset
= PSB_SGX_OFFSET
,
378 .chip_setup
= psb_chip_setup
,
379 .chip_teardown
= psb_chip_teardown
,
381 .crtc_helper
= &psb_intel_helper_funcs
,
382 .crtc_funcs
= &psb_intel_crtc_funcs
,
384 .output_init
= psb_output_init
,
386 #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE
387 .backlight_init
= psb_backlight_init
,
390 .init_pm
= psb_init_pm
,
391 .save_regs
= psb_save_display_registers
,
392 .restore_regs
= psb_restore_display_registers
,
393 .power_down
= psb_power_down
,
394 .power_up
= psb_power_up
,