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?*/
273 static int psbfb_ioctl(struct fb_info
*info
, unsigned int cmd
, unsigned long arg
)
275 struct psb_fbdev
*fbdev
= info
->par
;
276 struct psb_framebuffer
*psbfb
= fbdev
->pfb
;
277 struct drm_device
*dev
= psbfb
->base
.dev
;
278 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
279 u32 __user
*p
= (u32 __user
*)arg
;
284 if (!capable(CAP_SYS_RAWIO
))
290 if (copy_from_user(buf
, p
+ 1, l
* sizeof(u32
)))
292 psbfb_2d_submit(dev_priv
, buf
, l
);
299 static struct fb_ops psbfb_ops
= {
300 .owner
= THIS_MODULE
,
301 .fb_check_var
= drm_fb_helper_check_var
,
302 .fb_set_par
= drm_fb_helper_set_par
,
303 .fb_blank
= drm_fb_helper_blank
,
304 .fb_setcolreg
= psbfb_setcolreg
,
305 .fb_fillrect
= psbfb_fillrect
,
306 .fb_copyarea
= psbfb_copyarea
,
307 .fb_imageblit
= psbfb_imageblit
,
308 .fb_mmap
= psbfb_mmap
,
309 .fb_sync
= psbfb_sync
,
310 .fb_ioctl
= psbfb_ioctl
,
313 static struct drm_framebuffer
*psb_framebuffer_create
314 (struct drm_device
*dev
, struct drm_mode_fb_cmd
*r
,
317 struct psb_framebuffer
*fb
;
320 fb
= kzalloc(sizeof(*fb
), GFP_KERNEL
);
324 ret
= drm_framebuffer_init(dev
, &fb
->base
, &psb_fb_funcs
);
329 drm_helper_mode_fill_fb_struct(&fb
->base
, r
);
340 static struct drm_framebuffer
*psb_user_framebuffer_create
341 (struct drm_device
*dev
, struct drm_file
*filp
,
342 struct drm_mode_fb_cmd
*r
)
346 struct ttm_buffer_object
*bo
= NULL
;
349 bo
= ttm_buffer_object_lookup(psb_fpriv(filp
)->tfile
, r
->handle
);
353 /* JB: TODO not drop, make smarter */
354 size
= ((uint64_t) bo
->num_pages
) << PAGE_SHIFT
;
355 if (size
< r
->width
* r
->height
* 4)
358 /* JB: TODO not drop, refcount buffer */
359 return psb_framebuffer_create(dev
, r
, bo
);
361 struct psb_framebuffer
*psbfb
;
362 struct drm_framebuffer
*fb
;
363 struct fb_info
*info
;
364 void *psKernelMemInfo
= NULL
;
365 void * hKernelMemInfo
= (void *)r
->handle
;
366 struct drm_psb_private
*dev_priv
367 = (struct drm_psb_private
*)dev
->dev_private
;
368 struct psb_fbdev
*fbdev
= dev_priv
->fbdev
;
369 struct psb_gtt
*pg
= dev_priv
->pg
;
374 ret
= psb_get_meminfo_by_handle(hKernelMemInfo
, &psKernelMemInfo
);
376 DRM_ERROR("Cannot get meminfo for handle 0x%x\n",
377 (u32
)hKernelMemInfo
);
381 DRM_DEBUG("Got Kernel MemInfo for handle %lx\n",
382 (u32
)hKernelMemInfo
);
384 /* JB: TODO not drop, make smarter */
385 size
= psKernelMemInfo
->ui32AllocSize
;
386 if (size
< r
->height
* r
->pitch
)
389 /* JB: TODO not drop, refcount buffer */
390 /* return psb_framebuffer_create(dev, r, bo); */
392 fb
= psb_framebuffer_create(dev
, r
, (void *)psKernelMemInfo
);
394 DRM_ERROR("failed to allocate fb.\n");
398 psbfb
= to_psb_fb(fb
);
400 psbfb
->hKernelMemInfo
= hKernelMemInfo
;
402 DRM_DEBUG("Mapping to gtt..., KernelMemInfo %p\n", psKernelMemInfo
);
404 /*if not VRAM, map it into tt aperture*/
405 if (psKernelMemInfo
->pvLinAddrKM
!= pg
->vram_addr
) {
406 ret
= psb_gtt_map_meminfo(dev
, hKernelMemInfo
, &offset
);
408 DRM_ERROR("map meminfo for 0x%x failed\n",
409 (u32
)hKernelMemInfo
);
412 psbfb
->offset
= (offset
<< PAGE_SHIFT
);
416 info
= framebuffer_alloc(0, &dev
->pdev
->dev
);
420 strcpy(info
->fix
.id
, "psbfb");
422 info
->flags
= FBINFO_DEFAULT
;
423 info
->fix
.accel
= FB_ACCEL_I830
; /*FIXMEAC*/
424 info
->fbops
= &psbfb_ops
;
426 info
->fix
.smem_start
= dev
->mode_config
.fb_base
;
427 info
->fix
.smem_len
= size
;
429 info
->screen_base
= psKernelMemInfo
->pvLinAddrKM
;
430 info
->screen_size
= size
;
432 drm_fb_helper_fill_fix(info
, fb
->pitch
, fb
->depth
);
433 drm_fb_helper_fill_var(info
, &fbdev
->psb_fb_helper
,
434 fb
->width
, fb
->height
);
436 info
->fix
.mmio_start
= pci_resource_start(dev
->pdev
, 0);
437 info
->fix
.mmio_len
= pci_resource_len(dev
->pdev
, 0);
439 info
->pixmap
.size
= 64 * 1024;
440 info
->pixmap
.buf_align
= 8;
441 info
->pixmap
.access_align
= 32;
442 info
->pixmap
.flags
= FB_PIXMAP_SYSTEM
;
443 info
->pixmap
.scan_align
= 1;
448 fbdev
->psb_fb_helper
.fb
= fb
;
449 fbdev
->psb_fb_helper
.fbdev
= info
;
450 MRSTLFBHandleChangeFB(dev
, psbfb
);
456 static int psbfb_create(struct psb_fbdev
*fbdev
,
457 struct drm_fb_helper_surface_size
*sizes
)
459 struct drm_device
*dev
= fbdev
->psb_fb_helper
.dev
;
460 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
461 struct psb_gtt
*pg
= dev_priv
->pg
;
462 struct fb_info
*info
;
463 struct drm_framebuffer
*fb
;
464 struct psb_framebuffer
*psbfb
;
465 struct drm_mode_fb_cmd mode_cmd
;
466 struct device
*device
= &dev
->pdev
->dev
;
468 struct ttm_buffer_object
*fbo
= NULL
;
469 int size
, aligned_size
;
472 mode_cmd
.width
= sizes
->surface_width
;
473 mode_cmd
.height
= sizes
->surface_height
;
476 /* HW requires pitch to be 64 byte aligned */
477 mode_cmd
.pitch
= ALIGN(mode_cmd
.width
* ((mode_cmd
.bpp
+ 1) / 8), 64);
480 size
= mode_cmd
.pitch
* mode_cmd
.height
;
481 aligned_size
= ALIGN(size
, PAGE_SIZE
);
483 mutex_lock(&dev
->struct_mutex
);
484 fb
= psb_framebuffer_create(dev
, &mode_cmd
, fbo
);
486 DRM_ERROR("failed to allocate fb.\n");
490 psbfb
= to_psb_fb(fb
);
493 info
= framebuffer_alloc(sizeof(struct psb_fbdev
), device
);
503 fbdev
->psb_fb_helper
.fb
= fb
;
504 fbdev
->psb_fb_helper
.fbdev
= info
;
507 strcpy(info
->fix
.id
, "psbfb");
509 info
->flags
= FBINFO_DEFAULT
;
510 info
->fbops
= &psbfb_ops
;
511 info
->fix
.smem_start
= dev
->mode_config
.fb_base
;
512 info
->fix
.smem_len
= size
;
513 info
->screen_base
= (char *)pg
->vram_addr
;
514 info
->screen_size
= size
;
515 memset(info
->screen_base
, 0, size
);
517 drm_fb_helper_fill_fix(info
, fb
->pitch
, fb
->depth
);
518 drm_fb_helper_fill_var(info
, &fbdev
->psb_fb_helper
,
519 sizes
->fb_width
, sizes
->fb_height
);
521 info
->fix
.mmio_start
= pci_resource_start(dev
->pdev
, 0);
522 info
->fix
.mmio_len
= pci_resource_len(dev
->pdev
, 0);
524 info
->pixmap
.size
= 64 * 1024;
525 info
->pixmap
.buf_align
= 8;
526 info
->pixmap
.access_align
= 32;
527 info
->pixmap
.flags
= FB_PIXMAP_SYSTEM
;
528 info
->pixmap
.scan_align
= 1;
530 DRM_DEBUG("fb depth is %d\n", fb
->depth
);
531 DRM_DEBUG(" pitch is %d\n", fb
->pitch
);
533 printk(KERN_INFO
"allocated %dx%d fb\n",
534 psbfb
->base
.width
, psbfb
->base
.height
);
536 mutex_unlock(&dev
->struct_mutex
);
540 fb
->funcs
->destroy(fb
);
542 mutex_unlock(&dev
->struct_mutex
);
546 static void psbfb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
549 DRM_DEBUG("%s\n", __func__
);
552 static void psbfb_gamma_get(struct drm_crtc
*crtc
, u16
*red
,
553 u16
*green
, u16
*blue
, int regno
)
555 DRM_DEBUG("%s\n", __func__
);
558 static int psbfb_probe(struct drm_fb_helper
*helper
,
559 struct drm_fb_helper_surface_size
*sizes
)
561 struct psb_fbdev
*psb_fbdev
= (struct psb_fbdev
*)helper
;
565 DRM_DEBUG("%s\n", __func__
);
568 ret
= psbfb_create(psb_fbdev
, sizes
);
576 struct drm_fb_helper_funcs psb_fb_helper_funcs
= {
577 .gamma_set
= psbfb_gamma_set
,
578 .gamma_get
= psbfb_gamma_get
,
579 .fb_probe
= psbfb_probe
,
582 int psb_fbdev_destroy(struct drm_device
*dev
, struct psb_fbdev
*fbdev
)
584 struct fb_info
*info
;
585 struct psb_framebuffer
*psbfb
= fbdev
->pfb
;
587 if (fbdev
->psb_fb_helper
.fbdev
) {
588 info
= fbdev
->psb_fb_helper
.fbdev
;
589 unregister_framebuffer(info
);
590 iounmap(info
->screen_base
);
591 framebuffer_release(info
);
594 drm_fb_helper_fini(&fbdev
->psb_fb_helper
);
596 drm_framebuffer_cleanup(&psbfb
->base
);
601 int psb_fbdev_init(struct drm_device
*dev
)
603 struct psb_fbdev
*fbdev
;
604 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
607 fbdev
= kzalloc(sizeof(struct psb_fbdev
), GFP_KERNEL
);
609 DRM_ERROR("no memory\n");
613 dev_priv
->fbdev
= fbdev
;
614 fbdev
->psb_fb_helper
.funcs
= &psb_fb_helper_funcs
;
618 drm_fb_helper_init(dev
, &fbdev
->psb_fb_helper
, num_crtc
,
621 drm_fb_helper_single_add_all_connectors(&fbdev
->psb_fb_helper
);
622 drm_fb_helper_initial_config(&fbdev
->psb_fb_helper
, 32);
626 void psb_fbdev_fini(struct drm_device
*dev
)
628 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
630 if (!dev_priv
->fbdev
)
633 psb_fbdev_destroy(dev
, dev_priv
->fbdev
);
634 kfree(dev_priv
->fbdev
);
635 dev_priv
->fbdev
= NULL
;
639 static void psbfb_output_poll_changed(struct drm_device
*dev
)
641 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
642 struct psb_fbdev
*fbdev
= (struct psb_fbdev
*)dev_priv
->fbdev
;
643 drm_fb_helper_hotplug_event(&fbdev
->psb_fb_helper
);
646 int psbfb_remove(struct drm_device
*dev
, struct drm_framebuffer
*fb
)
648 struct fb_info
*info
;
649 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
658 framebuffer_release(info
);
661 /*EXPORT_SYMBOL(psbfb_remove); */
663 static int psb_user_framebuffer_create_handle(struct drm_framebuffer
*fb
,
664 struct drm_file
*file_priv
,
665 unsigned int *handle
)
667 /* JB: TODO currently we can't go from a bo to a handle with ttm */
673 static void psb_user_framebuffer_destroy(struct drm_framebuffer
*fb
)
675 struct drm_device
*dev
= fb
->dev
;
676 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
679 psb_gtt_unmap_meminfo(dev
, psbfb
->hKernelMemInfo
);
681 psbfb_remove(dev
, fb
);
683 /* JB: TODO not drop, refcount buffer */
684 drm_framebuffer_cleanup(fb
);
688 static const struct drm_mode_config_funcs psb_mode_funcs
= {
689 .fb_create
= psb_user_framebuffer_create
,
690 .output_poll_changed
= psbfb_output_poll_changed
,
693 static int psb_create_backlight_property(struct drm_device
*dev
)
695 struct drm_psb_private
*dev_priv
696 = (struct drm_psb_private
*) dev
->dev_private
;
697 struct drm_property
*backlight
;
699 if (dev_priv
->backlight_property
)
702 backlight
= drm_property_create(dev
,
706 backlight
->values
[0] = 0;
707 backlight
->values
[1] = 100;
709 dev_priv
->backlight_property
= backlight
;
714 static void psb_setup_outputs(struct drm_device
*dev
)
716 struct drm_psb_private
*dev_priv
=
717 (struct drm_psb_private
*) dev
->dev_private
;
718 struct drm_connector
*connector
;
720 PSB_DEBUG_ENTRY("\n");
722 drm_mode_create_scaling_mode_property(dev
);
724 psb_create_backlight_property(dev
);
727 if (dev_priv
->iLVDS_enable
)
728 mrst_lvds_init(dev
, &dev_priv
->mode_dev
);
730 DRM_ERROR("DSI is not supported\n");
732 psb_intel_lvds_init(dev
, &dev_priv
->mode_dev
);
733 psb_intel_sdvo_init(dev
, SDVOB
);
736 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
,
738 struct psb_intel_output
*psb_intel_output
=
739 to_psb_intel_output(connector
);
740 struct drm_encoder
*encoder
= &psb_intel_output
->enc
;
741 int crtc_mask
= 0, clone_mask
= 0;
744 switch (psb_intel_output
->type
) {
745 case INTEL_OUTPUT_SDVO
:
746 crtc_mask
= ((1 << 0) | (1 << 1));
747 clone_mask
= (1 << INTEL_OUTPUT_SDVO
);
749 case INTEL_OUTPUT_LVDS
:
750 PSB_DEBUG_ENTRY("LVDS.\n");
752 crtc_mask
= (1 << 0);
754 crtc_mask
= (1 << 1);
755 clone_mask
= (1 << INTEL_OUTPUT_LVDS
);
757 case INTEL_OUTPUT_MIPI
:
758 PSB_DEBUG_ENTRY("MIPI.\n");
759 crtc_mask
= (1 << 0);
760 clone_mask
= (1 << INTEL_OUTPUT_MIPI
);
762 case INTEL_OUTPUT_MIPI2
:
763 PSB_DEBUG_ENTRY("MIPI2.\n");
764 crtc_mask
= (1 << 2);
765 clone_mask
= (1 << INTEL_OUTPUT_MIPI2
);
767 case INTEL_OUTPUT_HDMI
:
768 PSB_DEBUG_ENTRY("HDMI.\n");
769 crtc_mask
= (1 << 1);
770 clone_mask
= (1 << INTEL_OUTPUT_HDMI
);
774 encoder
->possible_crtcs
= crtc_mask
;
775 encoder
->possible_clones
=
776 psb_intel_connector_clones(dev
, clone_mask
);
781 static void *psb_bo_from_handle(struct drm_device
*dev
,
782 struct drm_file
*file_priv
,
785 void *psKernelMemInfo
= NULL
;
786 void * hKernelMemInfo
= (void *)handle
;
789 ret
= psb_get_meminfo_by_handle(hKernelMemInfo
, &psKernelMemInfo
);
791 DRM_ERROR("Cannot get meminfo for handle 0x%x\n",
792 (u32
)hKernelMemInfo
);
796 return (void *)psKernelMemInfo
;
799 static size_t psb_bo_size(struct drm_device
*dev
, void *bof
)
802 void *psKernelMemInfo
= (void *)bof
;
803 return (size_t)psKernelMemInfo
->ui32AllocSize
;
809 static size_t psb_bo_offset(struct drm_device
*dev
, void *bof
)
811 struct psb_framebuffer
*psbfb
812 = (struct psb_framebuffer
*)bof
;
814 return (size_t)psbfb
->offset
;
817 static int psb_bo_pin_for_scanout(struct drm_device
*dev
, void *bo
)
822 static int psb_bo_unpin_for_scanout(struct drm_device
*dev
, void *bo
)
827 void psb_modeset_init(struct drm_device
*dev
)
829 struct drm_psb_private
*dev_priv
=
830 (struct drm_psb_private
*) dev
->dev_private
;
831 struct psb_intel_mode_device
*mode_dev
= &dev_priv
->mode_dev
;
834 PSB_DEBUG_ENTRY("\n");
835 /* Init mm functions */
836 mode_dev
->bo_from_handle
= psb_bo_from_handle
;
837 mode_dev
->bo_size
= psb_bo_size
;
838 mode_dev
->bo_offset
= psb_bo_offset
;
839 mode_dev
->bo_pin_for_scanout
= psb_bo_pin_for_scanout
;
840 mode_dev
->bo_unpin_for_scanout
= psb_bo_unpin_for_scanout
;
842 drm_mode_config_init(dev
);
844 dev
->mode_config
.min_width
= 0;
845 dev
->mode_config
.min_height
= 0;
847 dev
->mode_config
.funcs
= (void *) &psb_mode_funcs
;
849 /* set memory base */
850 /* MRST and PSB should use BAR 2*/
851 pci_read_config_dword(dev
->pdev
, PSB_BSM
, (u32
*)
852 &(dev
->mode_config
.fb_base
));
854 /* num pipes is 2 for PSB but 1 for Mrst */
855 for (i
= 0; i
< dev_priv
->num_pipe
; i
++)
856 psb_intel_crtc_init(dev
, i
, mode_dev
);
858 dev
->mode_config
.max_width
= 2048;
859 dev
->mode_config
.max_height
= 2048;
861 psb_setup_outputs(dev
);
864 /* drm_initial_config(dev); */
867 void psb_modeset_cleanup(struct drm_device
*dev
)
869 mutex_lock(&dev
->struct_mutex
);
871 drm_kms_helper_poll_fini(dev
);
874 drm_mode_config_cleanup(dev
);
876 mutex_unlock(&dev
->struct_mutex
);