1 /**************************************************************************
2 * Copyright (c) 2007, 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/module.h>
21 #include <linux/kernel.h>
22 #include <linux/errno.h>
23 #include <linux/string.h>
25 #include <linux/tty.h>
26 #include <linux/slab.h>
27 #include <linux/delay.h>
29 #include <linux/init.h>
30 #include <linux/console.h>
34 #include <drm/drm_crtc.h>
37 #include "psb_intel_reg.h"
38 #include "psb_intel_drv.h"
40 #include "psb_pvr_glue.h"
42 static void psb_user_framebuffer_destroy(struct drm_framebuffer
*fb
);
43 static int psb_user_framebuffer_create_handle(struct drm_framebuffer
*fb
,
44 struct drm_file
*file_priv
,
45 unsigned int *handle
);
47 static const struct drm_framebuffer_funcs psb_fb_funcs
= {
48 .destroy
= psb_user_framebuffer_destroy
,
49 .create_handle
= psb_user_framebuffer_create_handle
,
52 #define CMAP_TOHW(_val, _width) ((((_val) << (_width)) + 0x7FFF - (_val)) >> 16)
54 void *psbfb_vdc_reg(struct drm_device
*dev
)
56 struct drm_psb_private
*dev_priv
;
57 dev_priv
= (struct drm_psb_private
*) dev
->dev_private
;
58 return dev_priv
->vdc_reg
;
60 /*EXPORT_SYMBOL(psbfb_vdc_reg); */
62 static int psbfb_setcolreg(unsigned regno
, unsigned red
, unsigned green
,
63 unsigned blue
, unsigned transp
,
66 struct psb_fbdev
*fbdev
= info
->par
;
67 struct drm_framebuffer
*fb
= fbdev
->psb_fb_helper
.fb
;
76 red
= CMAP_TOHW(red
, info
->var
.red
.length
);
77 blue
= CMAP_TOHW(blue
, info
->var
.blue
.length
);
78 green
= CMAP_TOHW(green
, info
->var
.green
.length
);
79 transp
= CMAP_TOHW(transp
, info
->var
.transp
.length
);
81 v
= (red
<< info
->var
.red
.offset
) |
82 (green
<< info
->var
.green
.offset
) |
83 (blue
<< info
->var
.blue
.offset
) |
84 (transp
<< info
->var
.transp
.offset
);
87 switch (fb
->bits_per_pixel
) {
89 ((uint32_t *) info
->pseudo_palette
)[regno
] = v
;
93 ((uint32_t *) info
->pseudo_palette
)[regno
] = v
;
101 static int psbfb_kms_off(struct drm_device
*dev
, int suspend
)
103 struct drm_framebuffer
*fb
= 0;
104 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
105 DRM_DEBUG("psbfb_kms_off_ioctl\n");
107 mutex_lock(&dev
->mode_config
.mutex
);
108 list_for_each_entry(fb
, &dev
->mode_config
.fb_list
, head
) {
109 struct fb_info
*info
= psbfb
->fbdev
;
112 fb_set_suspend(info
, 1);
113 drm_fb_helper_blank(FB_BLANK_POWERDOWN
, info
);
116 mutex_unlock(&dev
->mode_config
.mutex
);
120 int psbfb_kms_off_ioctl(struct drm_device
*dev
, void *data
,
121 struct drm_file
*file_priv
)
128 ret
= psbfb_kms_off(dev
, 0);
134 static int psbfb_kms_on(struct drm_device
*dev
, int resume
)
136 struct drm_framebuffer
*fb
= 0;
137 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
139 DRM_DEBUG("psbfb_kms_on_ioctl\n");
141 mutex_lock(&dev
->mode_config
.mutex
);
142 list_for_each_entry(fb
, &dev
->mode_config
.fb_list
, head
) {
143 struct fb_info
*info
= psbfb
->fbdev
;
146 fb_set_suspend(info
, 0);
147 drm_fb_helper_blank(FB_BLANK_UNBLANK
, info
);
150 mutex_unlock(&dev
->mode_config
.mutex
);
155 int psbfb_kms_on_ioctl(struct drm_device
*dev
, void *data
,
156 struct drm_file
*file_priv
)
163 ret
= psbfb_kms_on(dev
, 0);
165 drm_helper_disable_unused_functions(dev
);
169 void psbfb_suspend(struct drm_device
*dev
)
172 psbfb_kms_off(dev
, 1);
176 void psbfb_resume(struct drm_device
*dev
)
179 psbfb_kms_on(dev
, 1);
181 drm_helper_disable_unused_functions(dev
);
184 static int psbfb_vm_fault(struct vm_area_struct
*vma
, struct vm_fault
*vmf
)
188 unsigned long address
= 0;
191 struct psb_framebuffer
*psbfb
= vma
->vm_private_data
;
192 struct drm_device
*dev
= psbfb
->base
.dev
;
193 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
194 struct psb_gtt
*pg
= dev_priv
->pg
;
195 unsigned long phys_addr
= (unsigned long)pg
->stolen_base
;;
197 page_num
= (vma
->vm_end
- vma
->vm_start
) >> PAGE_SHIFT
;
199 address
= (unsigned long)vmf
->virtual_address
;
201 vma
->vm_page_prot
= pgprot_noncached(vma
->vm_page_prot
);
203 for (i
= 0; i
< page_num
; i
++) {
204 pfn
= (phys_addr
>> PAGE_SHIFT
); /* phys_to_pfn(phys_addr); */
206 ret
= vm_insert_mixed(vma
, address
, pfn
);
207 if (unlikely((ret
== -EBUSY
) || (ret
!= 0 && i
> 0)))
209 else if (unlikely(ret
!= 0)) {
210 ret
= (ret
== -ENOMEM
) ? VM_FAULT_OOM
: VM_FAULT_SIGBUS
;
214 address
+= PAGE_SIZE
;
215 phys_addr
+= PAGE_SIZE
;
218 return VM_FAULT_NOPAGE
;
221 static void psbfb_vm_open(struct vm_area_struct
*vma
)
223 DRM_DEBUG("vm_open\n");
226 static void psbfb_vm_close(struct vm_area_struct
*vma
)
228 DRM_DEBUG("vm_close\n");
231 static struct vm_operations_struct psbfb_vm_ops
= {
232 .fault
= psbfb_vm_fault
,
233 .open
= psbfb_vm_open
,
234 .close
= psbfb_vm_close
237 static int psbfb_mmap(struct fb_info
*info
, struct vm_area_struct
*vma
)
239 struct psb_fbdev
*fbdev
= info
->par
;
240 struct psb_framebuffer
*psbfb
= fbdev
->pfb
;
241 char *fb_screen_base
= NULL
;
242 struct drm_device
*dev
= psbfb
->base
.dev
;
243 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
244 struct psb_gtt
*pg
= dev_priv
->pg
;
246 if (vma
->vm_pgoff
!= 0)
248 if (vma
->vm_pgoff
> (~0UL >> PAGE_SHIFT
))
251 if (!psbfb
->addr_space
)
252 psbfb
->addr_space
= vma
->vm_file
->f_mapping
;
254 fb_screen_base
= (char *)info
->screen_base
;
256 DRM_DEBUG("vm_pgoff 0x%lx, screen base %p vram_addr %p\n",
257 vma
->vm_pgoff
, fb_screen_base
, pg
->vram_addr
);
259 /*if using stolen memory, */
260 if (fb_screen_base
== pg
->vram_addr
) {
261 vma
->vm_ops
= &psbfb_vm_ops
;
262 vma
->vm_private_data
= (void *)psbfb
;
263 vma
->vm_flags
|= VM_RESERVED
| VM_IO
|
264 VM_MIXEDMAP
| VM_DONTEXPAND
;
266 /*using IMG meminfo, can I use pvrmmap to map it?*/
274 static struct fb_ops psbfb_ops
= {
275 .owner
= THIS_MODULE
,
276 .fb_check_var
= drm_fb_helper_check_var
,
277 .fb_set_par
= drm_fb_helper_set_par
,
278 .fb_blank
= drm_fb_helper_blank
,
279 .fb_setcolreg
= psbfb_setcolreg
,
280 .fb_fillrect
= psbfb_fillrect
,
281 .fb_copyarea
= psbfb_copyarea
,
282 .fb_imageblit
= psbfb_imageblit
,
283 .fb_mmap
= psbfb_mmap
,
284 .fb_sync
= psbfb_sync
,
287 static struct drm_framebuffer
*psb_framebuffer_create
288 (struct drm_device
*dev
, struct drm_mode_fb_cmd
*r
,
291 struct psb_framebuffer
*fb
;
294 fb
= kzalloc(sizeof(*fb
), GFP_KERNEL
);
298 ret
= drm_framebuffer_init(dev
, &fb
->base
, &psb_fb_funcs
);
303 drm_helper_mode_fill_fb_struct(&fb
->base
, r
);
314 static struct drm_framebuffer
*psb_user_framebuffer_create
315 (struct drm_device
*dev
, struct drm_file
*filp
,
316 struct drm_mode_fb_cmd
*r
)
320 struct ttm_buffer_object
*bo
= NULL
;
323 bo
= ttm_buffer_object_lookup(psb_fpriv(filp
)->tfile
, r
->handle
);
327 /* JB: TODO not drop, make smarter */
328 size
= ((uint64_t) bo
->num_pages
) << PAGE_SHIFT
;
329 if (size
< r
->width
* r
->height
* 4)
332 /* JB: TODO not drop, refcount buffer */
333 return psb_framebuffer_create(dev
, r
, bo
);
335 struct psb_framebuffer
*psbfb
;
336 struct drm_framebuffer
*fb
;
337 struct fb_info
*info
;
338 void *psKernelMemInfo
= NULL
;
339 void * hKernelMemInfo
= (void *)r
->handle
;
340 struct drm_psb_private
*dev_priv
341 = (struct drm_psb_private
*)dev
->dev_private
;
342 struct psb_fbdev
*fbdev
= dev_priv
->fbdev
;
343 struct psb_gtt
*pg
= dev_priv
->pg
;
348 ret
= psb_get_meminfo_by_handle(hKernelMemInfo
, &psKernelMemInfo
);
350 DRM_ERROR("Cannot get meminfo for handle 0x%x\n",
351 (u32
)hKernelMemInfo
);
355 DRM_DEBUG("Got Kernel MemInfo for handle %lx\n",
356 (u32
)hKernelMemInfo
);
358 /* JB: TODO not drop, make smarter */
359 size
= psKernelMemInfo
->ui32AllocSize
;
360 if (size
< r
->height
* r
->pitch
)
363 /* JB: TODO not drop, refcount buffer */
364 /* return psb_framebuffer_create(dev, r, bo); */
366 fb
= psb_framebuffer_create(dev
, r
, (void *)psKernelMemInfo
);
368 DRM_ERROR("failed to allocate fb.\n");
372 psbfb
= to_psb_fb(fb
);
374 psbfb
->hKernelMemInfo
= hKernelMemInfo
;
376 DRM_DEBUG("Mapping to gtt..., KernelMemInfo %p\n", psKernelMemInfo
);
378 /*if not VRAM, map it into tt aperture*/
379 if (psKernelMemInfo
->pvLinAddrKM
!= pg
->vram_addr
) {
380 ret
= psb_gtt_map_meminfo(dev
, hKernelMemInfo
, &offset
);
382 DRM_ERROR("map meminfo for 0x%x failed\n",
383 (u32
)hKernelMemInfo
);
386 psbfb
->offset
= (offset
<< PAGE_SHIFT
);
390 info
= framebuffer_alloc(0, &dev
->pdev
->dev
);
394 strcpy(info
->fix
.id
, "psbfb");
396 info
->flags
= FBINFO_DEFAULT
;
397 info
->fix
.accel
= FB_ACCEL_I830
; /*FIXMEAC*/
398 info
->fbops
= &psbfb_ops
;
400 info
->fix
.smem_start
= dev
->mode_config
.fb_base
;
401 info
->fix
.smem_len
= size
;
403 info
->screen_base
= psKernelMemInfo
->pvLinAddrKM
;
404 info
->screen_size
= size
;
406 drm_fb_helper_fill_fix(info
, fb
->pitch
, fb
->depth
);
407 drm_fb_helper_fill_var(info
, &fbdev
->psb_fb_helper
,
408 fb
->width
, fb
->height
);
410 info
->fix
.mmio_start
= pci_resource_start(dev
->pdev
, 0);
411 info
->fix
.mmio_len
= pci_resource_len(dev
->pdev
, 0);
413 info
->pixmap
.size
= 64 * 1024;
414 info
->pixmap
.buf_align
= 8;
415 info
->pixmap
.access_align
= 32;
416 info
->pixmap
.flags
= FB_PIXMAP_SYSTEM
;
417 info
->pixmap
.scan_align
= 1;
422 fbdev
->psb_fb_helper
.fb
= fb
;
423 fbdev
->psb_fb_helper
.fbdev
= info
;
424 MRSTLFBHandleChangeFB(dev
, psbfb
);
430 static int psbfb_create(struct psb_fbdev
*fbdev
,
431 struct drm_fb_helper_surface_size
*sizes
)
433 struct drm_device
*dev
= fbdev
->psb_fb_helper
.dev
;
434 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
435 struct psb_gtt
*pg
= dev_priv
->pg
;
436 struct fb_info
*info
;
437 struct drm_framebuffer
*fb
;
438 struct psb_framebuffer
*psbfb
;
439 struct drm_mode_fb_cmd mode_cmd
;
440 struct device
*device
= &dev
->pdev
->dev
;
442 struct ttm_buffer_object
*fbo
= NULL
;
443 int size
, aligned_size
;
446 mode_cmd
.width
= sizes
->surface_width
;
447 mode_cmd
.height
= sizes
->surface_height
;
450 /* HW requires pitch to be 64 byte aligned */
451 mode_cmd
.pitch
= ALIGN(mode_cmd
.width
* ((mode_cmd
.bpp
+ 1) / 8), 64);
454 size
= mode_cmd
.pitch
* mode_cmd
.height
;
455 aligned_size
= ALIGN(size
, PAGE_SIZE
);
457 mutex_lock(&dev
->struct_mutex
);
458 fb
= psb_framebuffer_create(dev
, &mode_cmd
, fbo
);
460 DRM_ERROR("failed to allocate fb.\n");
464 psbfb
= to_psb_fb(fb
);
467 info
= framebuffer_alloc(sizeof(struct psb_fbdev
), device
);
477 fbdev
->psb_fb_helper
.fb
= fb
;
478 fbdev
->psb_fb_helper
.fbdev
= info
;
481 strcpy(info
->fix
.id
, "psbfb");
483 info
->flags
= FBINFO_DEFAULT
;
484 info
->fbops
= &psbfb_ops
;
485 info
->fix
.smem_start
= dev
->mode_config
.fb_base
;
486 info
->fix
.smem_len
= size
;
487 info
->screen_base
= (char *)pg
->vram_addr
;
488 info
->screen_size
= size
;
489 memset(info
->screen_base
, 0, size
);
491 drm_fb_helper_fill_fix(info
, fb
->pitch
, fb
->depth
);
492 drm_fb_helper_fill_var(info
, &fbdev
->psb_fb_helper
,
493 sizes
->fb_width
, sizes
->fb_height
);
495 info
->fix
.mmio_start
= pci_resource_start(dev
->pdev
, 0);
496 info
->fix
.mmio_len
= pci_resource_len(dev
->pdev
, 0);
498 info
->pixmap
.size
= 64 * 1024;
499 info
->pixmap
.buf_align
= 8;
500 info
->pixmap
.access_align
= 32;
501 info
->pixmap
.flags
= FB_PIXMAP_SYSTEM
;
502 info
->pixmap
.scan_align
= 1;
504 DRM_DEBUG("fb depth is %d\n", fb
->depth
);
505 DRM_DEBUG(" pitch is %d\n", fb
->pitch
);
507 printk(KERN_INFO
"allocated %dx%d fb\n",
508 psbfb
->base
.width
, psbfb
->base
.height
);
510 mutex_unlock(&dev
->struct_mutex
);
514 fb
->funcs
->destroy(fb
);
516 mutex_unlock(&dev
->struct_mutex
);
520 static void psbfb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
523 DRM_DEBUG("%s\n", __func__
);
526 static void psbfb_gamma_get(struct drm_crtc
*crtc
, u16
*red
,
527 u16
*green
, u16
*blue
, int regno
)
529 DRM_DEBUG("%s\n", __func__
);
532 static int psbfb_probe(struct drm_fb_helper
*helper
,
533 struct drm_fb_helper_surface_size
*sizes
)
535 struct psb_fbdev
*psb_fbdev
= (struct psb_fbdev
*)helper
;
539 DRM_DEBUG("%s\n", __func__
);
542 ret
= psbfb_create(psb_fbdev
, sizes
);
550 struct drm_fb_helper_funcs psb_fb_helper_funcs
= {
551 .gamma_set
= psbfb_gamma_set
,
552 .gamma_get
= psbfb_gamma_get
,
553 .fb_probe
= psbfb_probe
,
556 int psb_fbdev_destroy(struct drm_device
*dev
, struct psb_fbdev
*fbdev
)
558 struct fb_info
*info
;
559 struct psb_framebuffer
*psbfb
= fbdev
->pfb
;
561 if (fbdev
->psb_fb_helper
.fbdev
) {
562 info
= fbdev
->psb_fb_helper
.fbdev
;
563 unregister_framebuffer(info
);
564 iounmap(info
->screen_base
);
565 framebuffer_release(info
);
568 drm_fb_helper_fini(&fbdev
->psb_fb_helper
);
570 drm_framebuffer_cleanup(&psbfb
->base
);
575 int psb_fbdev_init(struct drm_device
*dev
)
577 struct psb_fbdev
*fbdev
;
578 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
581 fbdev
= kzalloc(sizeof(struct psb_fbdev
), GFP_KERNEL
);
583 DRM_ERROR("no memory\n");
587 dev_priv
->fbdev
= fbdev
;
588 fbdev
->psb_fb_helper
.funcs
= &psb_fb_helper_funcs
;
592 drm_fb_helper_init(dev
, &fbdev
->psb_fb_helper
, num_crtc
,
595 drm_fb_helper_single_add_all_connectors(&fbdev
->psb_fb_helper
);
596 drm_fb_helper_initial_config(&fbdev
->psb_fb_helper
, 32);
600 void psb_fbdev_fini(struct drm_device
*dev
)
602 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
604 if (!dev_priv
->fbdev
)
607 psb_fbdev_destroy(dev
, dev_priv
->fbdev
);
608 kfree(dev_priv
->fbdev
);
609 dev_priv
->fbdev
= NULL
;
613 static void psbfb_output_poll_changed(struct drm_device
*dev
)
615 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
616 struct psb_fbdev
*fbdev
= (struct psb_fbdev
*)dev_priv
->fbdev
;
617 drm_fb_helper_hotplug_event(&fbdev
->psb_fb_helper
);
620 int psbfb_remove(struct drm_device
*dev
, struct drm_framebuffer
*fb
)
622 struct fb_info
*info
;
623 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
632 framebuffer_release(info
);
635 /*EXPORT_SYMBOL(psbfb_remove); */
637 static int psb_user_framebuffer_create_handle(struct drm_framebuffer
*fb
,
638 struct drm_file
*file_priv
,
639 unsigned int *handle
)
641 /* JB: TODO currently we can't go from a bo to a handle with ttm */
647 static void psb_user_framebuffer_destroy(struct drm_framebuffer
*fb
)
649 struct drm_device
*dev
= fb
->dev
;
650 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
653 psb_gtt_unmap_meminfo(dev
, psbfb
->hKernelMemInfo
);
655 psbfb_remove(dev
, fb
);
657 /* JB: TODO not drop, refcount buffer */
658 drm_framebuffer_cleanup(fb
);
662 static const struct drm_mode_config_funcs psb_mode_funcs
= {
663 .fb_create
= psb_user_framebuffer_create
,
664 .output_poll_changed
= psbfb_output_poll_changed
,
667 static int psb_create_backlight_property(struct drm_device
*dev
)
669 struct drm_psb_private
*dev_priv
670 = (struct drm_psb_private
*) dev
->dev_private
;
671 struct drm_property
*backlight
;
673 if (dev_priv
->backlight_property
)
676 backlight
= drm_property_create(dev
,
680 backlight
->values
[0] = 0;
681 backlight
->values
[1] = 100;
683 dev_priv
->backlight_property
= backlight
;
688 static void psb_setup_outputs(struct drm_device
*dev
)
690 struct drm_psb_private
*dev_priv
=
691 (struct drm_psb_private
*) dev
->dev_private
;
692 struct drm_connector
*connector
;
694 PSB_DEBUG_ENTRY("\n");
696 drm_mode_create_scaling_mode_property(dev
);
698 psb_create_backlight_property(dev
);
701 if (dev_priv
->iLVDS_enable
)
702 mrst_lvds_init(dev
, &dev_priv
->mode_dev
);
704 DRM_ERROR("DSI is not supported\n");
706 /* FIXME: check if SDVO init should be re-enabled */
707 psb_intel_lvds_init(dev
, &dev_priv
->mode_dev
);
708 /* psb_intel_sdvo_init(dev, SDVOB); */
711 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
,
713 struct psb_intel_output
*psb_intel_output
=
714 to_psb_intel_output(connector
);
715 struct drm_encoder
*encoder
= &psb_intel_output
->enc
;
716 int crtc_mask
= 0, clone_mask
= 0;
719 switch (psb_intel_output
->type
) {
720 case INTEL_OUTPUT_SDVO
:
721 crtc_mask
= ((1 << 0) | (1 << 1));
722 clone_mask
= (1 << INTEL_OUTPUT_SDVO
);
724 case INTEL_OUTPUT_LVDS
:
725 PSB_DEBUG_ENTRY("LVDS.\n");
727 crtc_mask
= (1 << 0);
729 crtc_mask
= (1 << 1);
730 clone_mask
= (1 << INTEL_OUTPUT_LVDS
);
732 case INTEL_OUTPUT_MIPI
:
733 PSB_DEBUG_ENTRY("MIPI.\n");
734 crtc_mask
= (1 << 0);
735 clone_mask
= (1 << INTEL_OUTPUT_MIPI
);
737 case INTEL_OUTPUT_MIPI2
:
738 PSB_DEBUG_ENTRY("MIPI2.\n");
739 crtc_mask
= (1 << 2);
740 clone_mask
= (1 << INTEL_OUTPUT_MIPI2
);
742 case INTEL_OUTPUT_HDMI
:
743 PSB_DEBUG_ENTRY("HDMI.\n");
744 crtc_mask
= (1 << 1);
745 clone_mask
= (1 << INTEL_OUTPUT_HDMI
);
749 encoder
->possible_crtcs
= crtc_mask
;
750 encoder
->possible_clones
=
751 psb_intel_connector_clones(dev
, clone_mask
);
756 static void *psb_bo_from_handle(struct drm_device
*dev
,
757 struct drm_file
*file_priv
,
760 void *psKernelMemInfo
= NULL
;
761 void * hKernelMemInfo
= (void *)handle
;
764 ret
= psb_get_meminfo_by_handle(hKernelMemInfo
, &psKernelMemInfo
);
766 DRM_ERROR("Cannot get meminfo for handle 0x%x\n",
767 (u32
)hKernelMemInfo
);
771 return (void *)psKernelMemInfo
;
774 static size_t psb_bo_size(struct drm_device
*dev
, void *bof
)
777 void *psKernelMemInfo
= (void *)bof
;
778 return (size_t)psKernelMemInfo
->ui32AllocSize
;
784 static size_t psb_bo_offset(struct drm_device
*dev
, void *bof
)
786 struct psb_framebuffer
*psbfb
787 = (struct psb_framebuffer
*)bof
;
789 return (size_t)psbfb
->offset
;
792 static int psb_bo_pin_for_scanout(struct drm_device
*dev
, void *bo
)
797 static int psb_bo_unpin_for_scanout(struct drm_device
*dev
, void *bo
)
802 void psb_modeset_init(struct drm_device
*dev
)
804 struct drm_psb_private
*dev_priv
=
805 (struct drm_psb_private
*) dev
->dev_private
;
806 struct psb_intel_mode_device
*mode_dev
= &dev_priv
->mode_dev
;
809 PSB_DEBUG_ENTRY("\n");
810 /* Init mm functions */
811 mode_dev
->bo_from_handle
= psb_bo_from_handle
;
812 mode_dev
->bo_size
= psb_bo_size
;
813 mode_dev
->bo_offset
= psb_bo_offset
;
814 mode_dev
->bo_pin_for_scanout
= psb_bo_pin_for_scanout
;
815 mode_dev
->bo_unpin_for_scanout
= psb_bo_unpin_for_scanout
;
817 drm_mode_config_init(dev
);
819 dev
->mode_config
.min_width
= 0;
820 dev
->mode_config
.min_height
= 0;
822 dev
->mode_config
.funcs
= (void *) &psb_mode_funcs
;
824 /* set memory base */
825 /* MRST and PSB should use BAR 2*/
826 pci_read_config_dword(dev
->pdev
, PSB_BSM
, (u32
*)
827 &(dev
->mode_config
.fb_base
));
829 /* num pipes is 2 for PSB but 1 for Mrst */
830 for (i
= 0; i
< dev_priv
->num_pipe
; i
++)
831 psb_intel_crtc_init(dev
, i
, mode_dev
);
833 dev
->mode_config
.max_width
= 2048;
834 dev
->mode_config
.max_height
= 2048;
836 psb_setup_outputs(dev
);
839 /* drm_initial_config(dev); */
842 void psb_modeset_cleanup(struct drm_device
*dev
)
844 mutex_lock(&dev
->struct_mutex
);
846 drm_kms_helper_poll_fini(dev
);
849 drm_mode_config_cleanup(dev
);
851 mutex_unlock(&dev
->struct_mutex
);