Commit | Line | Data |
---|---|---|
5c49fd3a AC |
1 | /************************************************************************** |
2 | * Copyright (c) 2007-2011, Intel Corporation. | |
3 | * All Rights Reserved. | |
4 | * Copyright (c) 2008, Tungsten Graphics, Inc. Cedar Park, TX., USA. | |
5 | * All Rights Reserved. | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify it | |
8 | * under the terms and conditions of the GNU General Public License, | |
9 | * version 2, as published by the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope it will be useful, but WITHOUT | |
12 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
13 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
14 | * more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License along with | |
17 | * this program; if not, write to the Free Software Foundation, Inc., | |
18 | * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | |
19 | * | |
20 | **************************************************************************/ | |
21 | ||
22 | #include <drm/drmP.h> | |
23 | #include <drm/drm.h> | |
838fa588 | 24 | #include "gma_drm.h" |
5c49fd3a AC |
25 | #include "psb_drv.h" |
26 | #include "framebuffer.h" | |
27 | #include "psb_reg.h" | |
28 | #include "psb_intel_reg.h" | |
29 | #include "intel_bios.h" | |
30 | #include "mid_bios.h" | |
31 | #include <drm/drm_pciids.h> | |
32 | #include "power.h" | |
33 | #include <linux/cpu.h> | |
34 | #include <linux/notifier.h> | |
35 | #include <linux/spinlock.h> | |
36 | #include <linux/pm_runtime.h> | |
37 | #include <acpi/video.h> | |
af3a2cfb | 38 | #include <linux/module.h> |
5c49fd3a AC |
39 | |
40 | static int drm_psb_trap_pagefaults; | |
41 | ||
5c49fd3a AC |
42 | static int psb_probe(struct pci_dev *pdev, const struct pci_device_id *ent); |
43 | ||
5c49fd3a | 44 | MODULE_PARM_DESC(trap_pagefaults, "Error and reset on MMU pagefaults"); |
5c49fd3a AC |
45 | module_param_named(trap_pagefaults, drm_psb_trap_pagefaults, int, 0600); |
46 | ||
47 | ||
48 | static DEFINE_PCI_DEVICE_TABLE(pciidlist) = { | |
49 | { 0x8086, 0x8108, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &psb_chip_ops }, | |
50 | { 0x8086, 0x8109, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &psb_chip_ops }, | |
0cecdd81 | 51 | #if defined(CONFIG_DRM_GMA600) |
5c49fd3a AC |
52 | { 0x8086, 0x4100, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, |
53 | { 0x8086, 0x4101, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
54 | { 0x8086, 0x4102, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
55 | { 0x8086, 0x4103, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
56 | { 0x8086, 0x4104, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
57 | { 0x8086, 0x4105, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
58 | { 0x8086, 0x4106, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
59 | { 0x8086, 0x4107, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
56125db1 AC |
60 | /* Atom E620 */ |
61 | { 0x8086, 0x4108, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &oaktrail_chip_ops}, | |
5c49fd3a | 62 | #endif |
b6195aab | 63 | #if defined(CONFIG_DRM_GMA3600) |
5c49fd3a AC |
64 | { 0x8086, 0x0be0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, |
65 | { 0x8086, 0x0be1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
66 | { 0x8086, 0x0be2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
67 | { 0x8086, 0x0be3, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
68 | { 0x8086, 0x0be4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
69 | { 0x8086, 0x0be5, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
70 | { 0x8086, 0x0be6, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
71 | { 0x8086, 0x0be7, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (long) &cdv_chip_ops}, | |
72 | #endif | |
73 | { 0, 0, 0} | |
74 | }; | |
75 | MODULE_DEVICE_TABLE(pci, pciidlist); | |
76 | ||
77 | /* | |
78 | * Standard IOCTLs. | |
79 | */ | |
80 | ||
5c49fd3a | 81 | #define DRM_IOCTL_PSB_ADB \ |
770179d5 | 82 | DRM_IOWR(DRM_GMA_ADB + DRM_COMMAND_BASE, uint32_t) |
5c49fd3a | 83 | #define DRM_IOCTL_PSB_MODE_OPERATION \ |
770179d5 | 84 | DRM_IOWR(DRM_GMA_MODE_OPERATION + DRM_COMMAND_BASE, \ |
5c49fd3a AC |
85 | struct drm_psb_mode_operation_arg) |
86 | #define DRM_IOCTL_PSB_STOLEN_MEMORY \ | |
770179d5 | 87 | DRM_IOWR(DRM_GMA_STOLEN_MEMORY + DRM_COMMAND_BASE, \ |
5c49fd3a | 88 | struct drm_psb_stolen_memory_arg) |
5c49fd3a | 89 | #define DRM_IOCTL_PSB_GAMMA \ |
770179d5 | 90 | DRM_IOWR(DRM_GMA_GAMMA + DRM_COMMAND_BASE, \ |
5c49fd3a AC |
91 | struct drm_psb_dpst_lut_arg) |
92 | #define DRM_IOCTL_PSB_DPST_BL \ | |
770179d5 | 93 | DRM_IOWR(DRM_GMA_DPST_BL + DRM_COMMAND_BASE, \ |
5c49fd3a AC |
94 | uint32_t) |
95 | #define DRM_IOCTL_PSB_GET_PIPE_FROM_CRTC_ID \ | |
770179d5 | 96 | DRM_IOWR(DRM_GMA_GET_PIPE_FROM_CRTC_ID + DRM_COMMAND_BASE, \ |
5c49fd3a AC |
97 | struct drm_psb_get_pipe_from_crtc_id_arg) |
98 | #define DRM_IOCTL_PSB_GEM_CREATE \ | |
770179d5 | 99 | DRM_IOWR(DRM_GMA_GEM_CREATE + DRM_COMMAND_BASE, \ |
5c49fd3a AC |
100 | struct drm_psb_gem_create) |
101 | #define DRM_IOCTL_PSB_GEM_MMAP \ | |
770179d5 | 102 | DRM_IOWR(DRM_GMA_GEM_MMAP + DRM_COMMAND_BASE, \ |
5c49fd3a AC |
103 | struct drm_psb_gem_mmap) |
104 | ||
5c49fd3a AC |
105 | static int psb_adb_ioctl(struct drm_device *dev, void *data, |
106 | struct drm_file *file_priv); | |
107 | static int psb_mode_operation_ioctl(struct drm_device *dev, void *data, | |
108 | struct drm_file *file_priv); | |
109 | static int psb_stolen_memory_ioctl(struct drm_device *dev, void *data, | |
110 | struct drm_file *file_priv); | |
5c49fd3a AC |
111 | static int psb_gamma_ioctl(struct drm_device *dev, void *data, |
112 | struct drm_file *file_priv); | |
113 | static int psb_dpst_bl_ioctl(struct drm_device *dev, void *data, | |
114 | struct drm_file *file_priv); | |
115 | ||
116 | #define PSB_IOCTL_DEF(ioctl, func, flags) \ | |
117 | [DRM_IOCTL_NR(ioctl) - DRM_COMMAND_BASE] = {ioctl, flags, func} | |
118 | ||
119 | static struct drm_ioctl_desc psb_ioctls[] = { | |
5c49fd3a AC |
120 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_ADB, psb_adb_ioctl, DRM_AUTH), |
121 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_MODE_OPERATION, psb_mode_operation_ioctl, | |
122 | DRM_AUTH), | |
123 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_STOLEN_MEMORY, psb_stolen_memory_ioctl, | |
124 | DRM_AUTH), | |
5c49fd3a AC |
125 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_GAMMA, psb_gamma_ioctl, DRM_AUTH), |
126 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_DPST_BL, psb_dpst_bl_ioctl, DRM_AUTH), | |
127 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_GET_PIPE_FROM_CRTC_ID, | |
128 | psb_intel_get_pipe_from_crtc_id, 0), | |
129 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_GEM_CREATE, psb_gem_create_ioctl, | |
130 | DRM_UNLOCKED | DRM_AUTH), | |
131 | PSB_IOCTL_DEF(DRM_IOCTL_PSB_GEM_MMAP, psb_gem_mmap_ioctl, | |
132 | DRM_UNLOCKED | DRM_AUTH), | |
133 | }; | |
134 | ||
135 | static void psb_lastclose(struct drm_device *dev) | |
136 | { | |
137 | return; | |
138 | } | |
139 | ||
140 | static void psb_do_takedown(struct drm_device *dev) | |
141 | { | |
5c49fd3a AC |
142 | } |
143 | ||
144 | static int psb_do_init(struct drm_device *dev) | |
145 | { | |
146 | struct drm_psb_private *dev_priv = dev->dev_private; | |
147 | struct psb_gtt *pg = &dev_priv->gtt; | |
148 | ||
149 | uint32_t stolen_gtt; | |
150 | ||
151 | int ret = -ENOMEM; | |
152 | ||
153 | if (pg->mmu_gatt_start & 0x0FFFFFFF) { | |
154 | dev_err(dev->dev, "Gatt must be 256M aligned. This is a bug.\n"); | |
155 | ret = -EINVAL; | |
156 | goto out_err; | |
157 | } | |
158 | ||
159 | ||
160 | stolen_gtt = (pg->stolen_size >> PAGE_SHIFT) * 4; | |
161 | stolen_gtt = (stolen_gtt + PAGE_SIZE - 1) >> PAGE_SHIFT; | |
162 | stolen_gtt = | |
163 | (stolen_gtt < pg->gtt_pages) ? stolen_gtt : pg->gtt_pages; | |
164 | ||
165 | dev_priv->gatt_free_offset = pg->mmu_gatt_start + | |
166 | (stolen_gtt << PAGE_SHIFT) * 1024; | |
167 | ||
168 | if (1 || drm_debug) { | |
169 | uint32_t core_id = PSB_RSGX32(PSB_CR_CORE_ID); | |
170 | uint32_t core_rev = PSB_RSGX32(PSB_CR_CORE_REVISION); | |
171 | DRM_INFO("SGX core id = 0x%08x\n", core_id); | |
172 | DRM_INFO("SGX core rev major = 0x%02x, minor = 0x%02x\n", | |
173 | (core_rev & _PSB_CC_REVISION_MAJOR_MASK) >> | |
174 | _PSB_CC_REVISION_MAJOR_SHIFT, | |
175 | (core_rev & _PSB_CC_REVISION_MINOR_MASK) >> | |
176 | _PSB_CC_REVISION_MINOR_SHIFT); | |
177 | DRM_INFO | |
178 | ("SGX core rev maintenance = 0x%02x, designer = 0x%02x\n", | |
179 | (core_rev & _PSB_CC_REVISION_MAINTENANCE_MASK) >> | |
180 | _PSB_CC_REVISION_MAINTENANCE_SHIFT, | |
181 | (core_rev & _PSB_CC_REVISION_DESIGNER_MASK) >> | |
182 | _PSB_CC_REVISION_DESIGNER_SHIFT); | |
183 | } | |
184 | ||
185 | ||
186 | spin_lock_init(&dev_priv->irqmask_lock); | |
9242fe23 | 187 | spin_lock_init(&dev_priv->lock_2d); |
5c49fd3a AC |
188 | |
189 | PSB_WSGX32(0x00000000, PSB_CR_BIF_BANK0); | |
190 | PSB_WSGX32(0x00000000, PSB_CR_BIF_BANK1); | |
191 | PSB_RSGX32(PSB_CR_BIF_BANK1); | |
192 | PSB_WSGX32(PSB_RSGX32(PSB_CR_BIF_CTRL) | _PSB_MMU_ER_MASK, | |
193 | PSB_CR_BIF_CTRL); | |
194 | psb_spank(dev_priv); | |
195 | ||
196 | /* mmu_gatt ?? */ | |
197 | PSB_WSGX32(pg->gatt_start, PSB_CR_BIF_TWOD_REQ_BASE); | |
198 | return 0; | |
199 | out_err: | |
200 | psb_do_takedown(dev); | |
201 | return ret; | |
202 | } | |
203 | ||
204 | static int psb_driver_unload(struct drm_device *dev) | |
205 | { | |
206 | struct drm_psb_private *dev_priv = dev->dev_private; | |
207 | ||
208 | /* Kill vblank etc here */ | |
209 | ||
210 | gma_backlight_exit(dev); | |
211 | ||
f9f23a77 | 212 | psb_modeset_cleanup(dev); |
5c49fd3a AC |
213 | |
214 | if (dev_priv) { | |
215 | psb_lid_timer_takedown(dev_priv); | |
216 | gma_intel_opregion_exit(dev); | |
217 | ||
218 | if (dev_priv->ops->chip_teardown) | |
219 | dev_priv->ops->chip_teardown(dev); | |
220 | psb_do_takedown(dev); | |
221 | ||
222 | ||
223 | if (dev_priv->pf_pd) { | |
224 | psb_mmu_free_pagedir(dev_priv->pf_pd); | |
225 | dev_priv->pf_pd = NULL; | |
226 | } | |
227 | if (dev_priv->mmu) { | |
228 | struct psb_gtt *pg = &dev_priv->gtt; | |
229 | ||
230 | down_read(&pg->sem); | |
231 | psb_mmu_remove_pfn_sequence( | |
232 | psb_mmu_get_default_pd | |
233 | (dev_priv->mmu), | |
234 | pg->mmu_gatt_start, | |
235 | dev_priv->vram_stolen_size >> PAGE_SHIFT); | |
236 | up_read(&pg->sem); | |
237 | psb_mmu_driver_takedown(dev_priv->mmu); | |
238 | dev_priv->mmu = NULL; | |
239 | } | |
240 | psb_gtt_takedown(dev); | |
241 | if (dev_priv->scratch_page) { | |
242 | __free_page(dev_priv->scratch_page); | |
243 | dev_priv->scratch_page = NULL; | |
244 | } | |
245 | if (dev_priv->vdc_reg) { | |
246 | iounmap(dev_priv->vdc_reg); | |
247 | dev_priv->vdc_reg = NULL; | |
248 | } | |
249 | if (dev_priv->sgx_reg) { | |
250 | iounmap(dev_priv->sgx_reg); | |
251 | dev_priv->sgx_reg = NULL; | |
252 | } | |
253 | ||
254 | kfree(dev_priv); | |
255 | dev->dev_private = NULL; | |
256 | ||
257 | /*destroy VBT data*/ | |
258 | psb_intel_destroy_bios(dev); | |
259 | } | |
260 | ||
261 | gma_power_uninit(dev); | |
262 | ||
263 | return 0; | |
264 | } | |
265 | ||
266 | ||
267 | static int psb_driver_load(struct drm_device *dev, unsigned long chipset) | |
268 | { | |
269 | struct drm_psb_private *dev_priv; | |
270 | unsigned long resource_start; | |
271 | struct psb_gtt *pg; | |
272 | unsigned long irqflags; | |
273 | int ret = -ENOMEM; | |
274 | uint32_t tt_pages; | |
275 | struct drm_connector *connector; | |
1730f89b | 276 | struct psb_intel_encoder *psb_intel_encoder; |
5c49fd3a AC |
277 | |
278 | dev_priv = kzalloc(sizeof(*dev_priv), GFP_KERNEL); | |
279 | if (dev_priv == NULL) | |
280 | return -ENOMEM; | |
281 | ||
282 | dev_priv->ops = (struct psb_ops *)chipset; | |
283 | dev_priv->dev = dev; | |
284 | dev->dev_private = (void *) dev_priv; | |
285 | ||
466e69b8 DA |
286 | pci_set_master(dev->pdev); |
287 | ||
84b08fe6 PJ |
288 | if (!IS_PSB(dev)) { |
289 | if (pci_enable_msi(dev->pdev)) | |
290 | dev_warn(dev->dev, "Enabling MSI failed!\n"); | |
291 | } | |
292 | ||
5c49fd3a AC |
293 | dev_priv->num_pipe = dev_priv->ops->pipes; |
294 | ||
295 | resource_start = pci_resource_start(dev->pdev, PSB_MMIO_RESOURCE); | |
296 | ||
297 | dev_priv->vdc_reg = | |
298 | ioremap(resource_start + PSB_VDC_OFFSET, PSB_VDC_SIZE); | |
299 | if (!dev_priv->vdc_reg) | |
300 | goto out_err; | |
301 | ||
302 | dev_priv->sgx_reg = ioremap(resource_start + dev_priv->ops->sgx_offset, | |
303 | PSB_SGX_SIZE); | |
304 | if (!dev_priv->sgx_reg) | |
305 | goto out_err; | |
306 | ||
307 | ret = dev_priv->ops->chip_setup(dev); | |
308 | if (ret) | |
309 | goto out_err; | |
310 | ||
311 | /* Init OSPM support */ | |
312 | gma_power_init(dev); | |
313 | ||
314 | ret = -ENOMEM; | |
315 | ||
316 | dev_priv->scratch_page = alloc_page(GFP_DMA32 | __GFP_ZERO); | |
317 | if (!dev_priv->scratch_page) | |
318 | goto out_err; | |
319 | ||
320 | set_pages_uc(dev_priv->scratch_page, 1); | |
321 | ||
322 | ret = psb_gtt_init(dev, 0); | |
323 | if (ret) | |
324 | goto out_err; | |
325 | ||
326 | dev_priv->mmu = psb_mmu_driver_init((void *)0, | |
327 | drm_psb_trap_pagefaults, 0, | |
328 | dev_priv); | |
329 | if (!dev_priv->mmu) | |
330 | goto out_err; | |
331 | ||
332 | pg = &dev_priv->gtt; | |
333 | ||
334 | tt_pages = (pg->gatt_pages < PSB_TT_PRIV0_PLIMIT) ? | |
335 | (pg->gatt_pages) : PSB_TT_PRIV0_PLIMIT; | |
336 | ||
337 | ||
338 | dev_priv->pf_pd = psb_mmu_alloc_pd(dev_priv->mmu, 1, 0); | |
339 | if (!dev_priv->pf_pd) | |
340 | goto out_err; | |
341 | ||
342 | psb_mmu_set_pd_context(psb_mmu_get_default_pd(dev_priv->mmu), 0); | |
343 | psb_mmu_set_pd_context(dev_priv->pf_pd, 1); | |
344 | ||
345 | ret = psb_do_init(dev); | |
346 | if (ret) | |
347 | return ret; | |
348 | ||
349 | PSB_WSGX32(0x20000000, PSB_CR_PDS_EXEC_BASE); | |
350 | PSB_WSGX32(0x30000000, PSB_CR_BIF_3D_REQ_BASE); | |
351 | ||
352 | /* igd_opregion_init(&dev_priv->opregion_dev); */ | |
353 | acpi_video_register(); | |
354 | if (dev_priv->lid_state) | |
355 | psb_lid_timer_init(dev_priv); | |
356 | ||
357 | ret = drm_vblank_init(dev, dev_priv->num_pipe); | |
358 | if (ret) | |
359 | goto out_err; | |
360 | ||
361 | /* | |
362 | * Install interrupt handlers prior to powering off SGX or else we will | |
363 | * crash. | |
364 | */ | |
365 | dev_priv->vdc_irq_mask = 0; | |
366 | dev_priv->pipestat[0] = 0; | |
367 | dev_priv->pipestat[1] = 0; | |
368 | dev_priv->pipestat[2] = 0; | |
369 | spin_lock_irqsave(&dev_priv->irqmask_lock, irqflags); | |
370 | PSB_WVDC32(0xFFFFFFFF, PSB_HWSTAM); | |
371 | PSB_WVDC32(0x00000000, PSB_INT_ENABLE_R); | |
372 | PSB_WVDC32(0xFFFFFFFF, PSB_INT_MASK_R); | |
373 | spin_unlock_irqrestore(&dev_priv->irqmask_lock, irqflags); | |
e036ba59 | 374 | if (IS_PSB(dev) && drm_core_check_feature(dev, DRIVER_MODESET)) |
5c49fd3a AC |
375 | drm_irq_install(dev); |
376 | ||
377 | dev->vblank_disable_allowed = 1; | |
378 | ||
379 | dev->max_vblank_count = 0xffffff; /* only 24 bits of frame count */ | |
380 | ||
381 | dev->driver->get_vblank_counter = psb_get_vblank_counter; | |
382 | ||
f9f23a77 AC |
383 | psb_modeset_init(dev); |
384 | psb_fbdev_init(dev); | |
385 | drm_kms_helper_poll_init(dev); | |
5c49fd3a AC |
386 | |
387 | /* Only add backlight support if we have LVDS output */ | |
388 | list_for_each_entry(connector, &dev->mode_config.connector_list, | |
389 | head) { | |
1730f89b | 390 | psb_intel_encoder = psb_intel_attached_encoder(connector); |
5c49fd3a | 391 | |
1730f89b | 392 | switch (psb_intel_encoder->type) { |
5c49fd3a AC |
393 | case INTEL_OUTPUT_LVDS: |
394 | case INTEL_OUTPUT_MIPI: | |
395 | ret = gma_backlight_init(dev); | |
396 | break; | |
397 | } | |
398 | } | |
399 | ||
400 | if (ret) | |
401 | return ret; | |
402 | #if 0 | |
403 | /*enable runtime pm at last*/ | |
404 | pm_runtime_enable(&dev->pdev->dev); | |
405 | pm_runtime_set_active(&dev->pdev->dev); | |
406 | #endif | |
407 | /*Intel drm driver load is done, continue doing pvr load*/ | |
408 | return 0; | |
409 | out_err: | |
410 | psb_driver_unload(dev); | |
411 | return ret; | |
412 | } | |
413 | ||
414 | int psb_driver_device_is_agp(struct drm_device *dev) | |
415 | { | |
416 | return 0; | |
417 | } | |
418 | ||
5c49fd3a AC |
419 | static inline void get_brightness(struct backlight_device *bd) |
420 | { | |
421 | #ifdef CONFIG_BACKLIGHT_CLASS_DEVICE | |
422 | if (bd) { | |
423 | bd->props.brightness = bd->ops->get_brightness(bd); | |
424 | backlight_update_status(bd); | |
425 | } | |
426 | #endif | |
427 | } | |
428 | ||
429 | static int psb_dpst_bl_ioctl(struct drm_device *dev, void *data, | |
430 | struct drm_file *file_priv) | |
431 | { | |
432 | struct drm_psb_private *dev_priv = psb_priv(dev); | |
433 | uint32_t *arg = data; | |
434 | ||
435 | dev_priv->blc_adj2 = *arg; | |
436 | get_brightness(dev_priv->backlight_device); | |
437 | return 0; | |
438 | } | |
439 | ||
440 | static int psb_adb_ioctl(struct drm_device *dev, void *data, | |
441 | struct drm_file *file_priv) | |
442 | { | |
443 | struct drm_psb_private *dev_priv = psb_priv(dev); | |
444 | uint32_t *arg = data; | |
445 | ||
446 | dev_priv->blc_adj1 = *arg; | |
447 | get_brightness(dev_priv->backlight_device); | |
448 | return 0; | |
449 | } | |
450 | ||
5c49fd3a AC |
451 | static int psb_gamma_ioctl(struct drm_device *dev, void *data, |
452 | struct drm_file *file_priv) | |
453 | { | |
454 | struct drm_psb_dpst_lut_arg *lut_arg = data; | |
455 | struct drm_mode_object *obj; | |
456 | struct drm_crtc *crtc; | |
457 | struct drm_connector *connector; | |
458 | struct psb_intel_crtc *psb_intel_crtc; | |
459 | int i = 0; | |
460 | int32_t obj_id; | |
461 | ||
462 | obj_id = lut_arg->output_id; | |
463 | obj = drm_mode_object_find(dev, obj_id, DRM_MODE_OBJECT_CONNECTOR); | |
464 | if (!obj) { | |
465 | dev_dbg(dev->dev, "Invalid Connector object.\n"); | |
466 | return -EINVAL; | |
467 | } | |
468 | ||
469 | connector = obj_to_connector(obj); | |
470 | crtc = connector->encoder->crtc; | |
471 | psb_intel_crtc = to_psb_intel_crtc(crtc); | |
472 | ||
473 | for (i = 0; i < 256; i++) | |
474 | psb_intel_crtc->lut_adj[i] = lut_arg->lut[i]; | |
475 | ||
476 | psb_intel_crtc_load_lut(crtc); | |
477 | ||
478 | return 0; | |
479 | } | |
480 | ||
481 | static int psb_mode_operation_ioctl(struct drm_device *dev, void *data, | |
482 | struct drm_file *file_priv) | |
483 | { | |
484 | uint32_t obj_id; | |
485 | uint16_t op; | |
486 | struct drm_mode_modeinfo *umode; | |
487 | struct drm_display_mode *mode = NULL; | |
488 | struct drm_psb_mode_operation_arg *arg; | |
489 | struct drm_mode_object *obj; | |
490 | struct drm_connector *connector; | |
5c49fd3a AC |
491 | struct drm_connector_helper_funcs *connector_funcs; |
492 | int ret = 0; | |
493 | int resp = MODE_OK; | |
5c49fd3a AC |
494 | |
495 | arg = (struct drm_psb_mode_operation_arg *)data; | |
496 | obj_id = arg->obj_id; | |
497 | op = arg->operation; | |
498 | ||
499 | switch (op) { | |
5c49fd3a AC |
500 | case PSB_MODE_OPERATION_MODE_VALID: |
501 | umode = &arg->mode; | |
502 | ||
503 | mutex_lock(&dev->mode_config.mutex); | |
504 | ||
505 | obj = drm_mode_object_find(dev, obj_id, | |
506 | DRM_MODE_OBJECT_CONNECTOR); | |
507 | if (!obj) { | |
508 | ret = -EINVAL; | |
509 | goto mode_op_out; | |
510 | } | |
511 | ||
512 | connector = obj_to_connector(obj); | |
513 | ||
514 | mode = drm_mode_create(dev); | |
515 | if (!mode) { | |
516 | ret = -ENOMEM; | |
517 | goto mode_op_out; | |
518 | } | |
519 | ||
520 | /* drm_crtc_convert_umode(mode, umode); */ | |
521 | { | |
522 | mode->clock = umode->clock; | |
523 | mode->hdisplay = umode->hdisplay; | |
524 | mode->hsync_start = umode->hsync_start; | |
525 | mode->hsync_end = umode->hsync_end; | |
526 | mode->htotal = umode->htotal; | |
527 | mode->hskew = umode->hskew; | |
528 | mode->vdisplay = umode->vdisplay; | |
529 | mode->vsync_start = umode->vsync_start; | |
530 | mode->vsync_end = umode->vsync_end; | |
531 | mode->vtotal = umode->vtotal; | |
532 | mode->vscan = umode->vscan; | |
533 | mode->vrefresh = umode->vrefresh; | |
534 | mode->flags = umode->flags; | |
535 | mode->type = umode->type; | |
536 | strncpy(mode->name, umode->name, DRM_DISPLAY_MODE_LEN); | |
537 | mode->name[DRM_DISPLAY_MODE_LEN-1] = 0; | |
538 | } | |
539 | ||
540 | connector_funcs = (struct drm_connector_helper_funcs *) | |
541 | connector->helper_private; | |
542 | ||
543 | if (connector_funcs->mode_valid) { | |
544 | resp = connector_funcs->mode_valid(connector, mode); | |
61bedf70 | 545 | arg->data = resp; |
5c49fd3a AC |
546 | } |
547 | ||
548 | /*do some clean up work*/ | |
549 | if (mode) | |
550 | drm_mode_destroy(dev, mode); | |
551 | mode_op_out: | |
552 | mutex_unlock(&dev->mode_config.mutex); | |
553 | return ret; | |
554 | ||
555 | default: | |
556 | dev_dbg(dev->dev, "Unsupported psb mode operation\n"); | |
557 | return -EOPNOTSUPP; | |
558 | } | |
559 | ||
560 | return 0; | |
561 | } | |
562 | ||
563 | static int psb_stolen_memory_ioctl(struct drm_device *dev, void *data, | |
564 | struct drm_file *file_priv) | |
565 | { | |
566 | struct drm_psb_private *dev_priv = psb_priv(dev); | |
567 | struct drm_psb_stolen_memory_arg *arg = data; | |
568 | ||
569 | arg->base = dev_priv->stolen_base; | |
570 | arg->size = dev_priv->vram_stolen_size; | |
571 | ||
572 | return 0; | |
573 | } | |
574 | ||
5c49fd3a AC |
575 | static int psb_driver_open(struct drm_device *dev, struct drm_file *priv) |
576 | { | |
577 | return 0; | |
578 | } | |
579 | ||
580 | static void psb_driver_close(struct drm_device *dev, struct drm_file *priv) | |
581 | { | |
582 | } | |
583 | ||
584 | static long psb_unlocked_ioctl(struct file *filp, unsigned int cmd, | |
585 | unsigned long arg) | |
586 | { | |
587 | struct drm_file *file_priv = filp->private_data; | |
588 | struct drm_device *dev = file_priv->minor->dev; | |
589 | struct drm_psb_private *dev_priv = dev->dev_private; | |
590 | static unsigned int runtime_allowed; | |
591 | ||
592 | if (runtime_allowed == 1 && dev_priv->is_lvds_on) { | |
593 | runtime_allowed++; | |
594 | pm_runtime_allow(&dev->pdev->dev); | |
595 | dev_priv->rpm_enabled = 1; | |
596 | } | |
597 | return drm_ioctl(filp, cmd, arg); | |
598 | /* FIXME: do we need to wrap the other side of this */ | |
599 | } | |
600 | ||
601 | ||
602 | /* When a client dies: | |
603 | * - Check for and clean up flipped page state | |
604 | */ | |
605 | void psb_driver_preclose(struct drm_device *dev, struct drm_file *priv) | |
606 | { | |
607 | } | |
608 | ||
609 | static void psb_remove(struct pci_dev *pdev) | |
610 | { | |
611 | struct drm_device *dev = pci_get_drvdata(pdev); | |
612 | drm_put_dev(dev); | |
613 | } | |
614 | ||
615 | static const struct dev_pm_ops psb_pm_ops = { | |
616 | .resume = gma_power_resume, | |
617 | .suspend = gma_power_suspend, | |
618 | .runtime_suspend = psb_runtime_suspend, | |
619 | .runtime_resume = psb_runtime_resume, | |
620 | .runtime_idle = psb_runtime_idle, | |
621 | }; | |
622 | ||
623 | static struct vm_operations_struct psb_gem_vm_ops = { | |
624 | .fault = psb_gem_fault, | |
625 | .open = drm_gem_vm_open, | |
626 | .close = drm_gem_vm_close, | |
627 | }; | |
628 | ||
1595c568 IH |
629 | static const struct file_operations psb_gem_fops = { |
630 | .owner = THIS_MODULE, | |
631 | .open = drm_open, | |
632 | .release = drm_release, | |
633 | .unlocked_ioctl = psb_unlocked_ioctl, | |
634 | .mmap = drm_gem_mmap, | |
635 | .poll = drm_poll, | |
636 | .fasync = drm_fasync, | |
637 | .read = drm_read, | |
638 | }; | |
639 | ||
5c49fd3a AC |
640 | static struct drm_driver driver = { |
641 | .driver_features = DRIVER_HAVE_IRQ | DRIVER_IRQ_SHARED | \ | |
642 | DRIVER_IRQ_VBL | DRIVER_MODESET | DRIVER_GEM , | |
643 | .load = psb_driver_load, | |
644 | .unload = psb_driver_unload, | |
645 | ||
646 | .ioctls = psb_ioctls, | |
647 | .num_ioctls = DRM_ARRAY_SIZE(psb_ioctls), | |
648 | .device_is_agp = psb_driver_device_is_agp, | |
649 | .irq_preinstall = psb_irq_preinstall, | |
650 | .irq_postinstall = psb_irq_postinstall, | |
651 | .irq_uninstall = psb_irq_uninstall, | |
652 | .irq_handler = psb_irq_handler, | |
653 | .enable_vblank = psb_enable_vblank, | |
654 | .disable_vblank = psb_disable_vblank, | |
655 | .get_vblank_counter = psb_get_vblank_counter, | |
656 | .lastclose = psb_lastclose, | |
657 | .open = psb_driver_open, | |
658 | .preclose = psb_driver_preclose, | |
659 | .postclose = psb_driver_close, | |
660 | .reclaim_buffers = drm_core_reclaim_buffers, | |
661 | ||
662 | .gem_init_object = psb_gem_init_object, | |
663 | .gem_free_object = psb_gem_free_object, | |
664 | .gem_vm_ops = &psb_gem_vm_ops, | |
665 | .dumb_create = psb_gem_dumb_create, | |
666 | .dumb_map_offset = psb_gem_dumb_map_gtt, | |
667 | .dumb_destroy = psb_gem_dumb_destroy, | |
1595c568 | 668 | .fops = &psb_gem_fops, |
5c49fd3a AC |
669 | .name = DRIVER_NAME, |
670 | .desc = DRIVER_DESC, | |
671 | .date = PSB_DRM_DRIVER_DATE, | |
672 | .major = PSB_DRM_DRIVER_MAJOR, | |
673 | .minor = PSB_DRM_DRIVER_MINOR, | |
674 | .patchlevel = PSB_DRM_DRIVER_PATCHLEVEL | |
675 | }; | |
676 | ||
677 | static struct pci_driver psb_pci_driver = { | |
678 | .name = DRIVER_NAME, | |
679 | .id_table = pciidlist, | |
680 | .probe = psb_probe, | |
681 | .remove = psb_remove, | |
682 | .driver.pm = &psb_pm_ops, | |
683 | }; | |
684 | ||
685 | static int psb_probe(struct pci_dev *pdev, const struct pci_device_id *ent) | |
686 | { | |
5c49fd3a AC |
687 | return drm_get_pci_dev(pdev, ent, &driver); |
688 | } | |
689 | ||
690 | static int __init psb_init(void) | |
691 | { | |
692 | return drm_pci_init(&driver, &psb_pci_driver); | |
693 | } | |
694 | ||
695 | static void __exit psb_exit(void) | |
696 | { | |
697 | drm_pci_exit(&driver, &psb_pci_driver); | |
698 | } | |
699 | ||
700 | late_initcall(psb_init); | |
701 | module_exit(psb_exit); | |
702 | ||
703 | MODULE_AUTHOR("Alan Cox <alan@linux.intel.com> and others"); | |
704 | MODULE_DESCRIPTION(DRIVER_DESC); | |
705 | MODULE_LICENSE("GPL"); |