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 /* FIXME: ultimately this needs to become 'if entirely stolen memory' */
260 if (1 || 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 /* GTT memory backed by kernel/user pages, needs a different
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
);
331 fb
->mem
= mm_private
;
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
;
467 int size
, aligned_size
;
469 struct gtt_range
*backing
;
471 mode_cmd
.width
= sizes
->surface_width
;
472 mode_cmd
.height
= sizes
->surface_height
;
475 /* HW requires pitch to be 64 byte aligned */
476 mode_cmd
.pitch
= ALIGN(mode_cmd
.width
* ((mode_cmd
.bpp
+ 1) / 8), 64);
479 size
= mode_cmd
.pitch
* mode_cmd
.height
;
480 aligned_size
= ALIGN(size
, PAGE_SIZE
);
482 /* Allocate the framebuffer in the GTT with stolen page backing */
483 backing
= psb_gtt_alloc_range(dev
, aligned_size
, "fb", 1);
487 mutex_lock(&dev
->struct_mutex
);
488 fb
= psb_framebuffer_create(dev
, &mode_cmd
, backing
);
490 DRM_ERROR("failed to allocate fb.\n");
494 psbfb
= to_psb_fb(fb
);
497 info
= framebuffer_alloc(sizeof(struct psb_fbdev
), device
);
507 fbdev
->psb_fb_helper
.fb
= fb
;
508 fbdev
->psb_fb_helper
.fbdev
= info
;
511 strcpy(info
->fix
.id
, "psbfb");
513 info
->flags
= FBINFO_DEFAULT
;
514 info
->fbops
= &psbfb_ops
;
515 info
->fix
.smem_start
= dev
->mode_config
.fb_base
;
516 info
->fix
.smem_len
= size
;
518 /* Accessed via stolen memory directly, This only works for stolem
519 memory however. Need to address this once we start using gtt
521 info
->screen_base
= (char *)pg
->vram_addr
+ backing
->offset
;
522 info
->screen_size
= size
;
523 memset(info
->screen_base
, 0, size
);
525 drm_fb_helper_fill_fix(info
, fb
->pitch
, fb
->depth
);
526 drm_fb_helper_fill_var(info
, &fbdev
->psb_fb_helper
,
527 sizes
->fb_width
, sizes
->fb_height
);
529 info
->fix
.mmio_start
= pci_resource_start(dev
->pdev
, 0);
530 info
->fix
.mmio_len
= pci_resource_len(dev
->pdev
, 0);
532 info
->pixmap
.size
= 64 * 1024;
533 info
->pixmap
.buf_align
= 8;
534 info
->pixmap
.access_align
= 32;
535 info
->pixmap
.flags
= FB_PIXMAP_SYSTEM
;
536 info
->pixmap
.scan_align
= 1;
538 DRM_DEBUG("fb depth is %d\n", fb
->depth
);
539 DRM_DEBUG(" pitch is %d\n", fb
->pitch
);
541 printk(KERN_INFO
"allocated %dx%d fb\n",
542 psbfb
->base
.width
, psbfb
->base
.height
);
544 mutex_unlock(&dev
->struct_mutex
);
548 fb
->funcs
->destroy(fb
);
550 mutex_unlock(&dev
->struct_mutex
);
551 psb_gtt_free_range(dev
, backing
);
555 static void psbfb_gamma_set(struct drm_crtc
*crtc
, u16 red
, u16 green
,
558 DRM_DEBUG("%s\n", __func__
);
561 static void psbfb_gamma_get(struct drm_crtc
*crtc
, u16
*red
,
562 u16
*green
, u16
*blue
, int regno
)
564 DRM_DEBUG("%s\n", __func__
);
567 static int psbfb_probe(struct drm_fb_helper
*helper
,
568 struct drm_fb_helper_surface_size
*sizes
)
570 struct psb_fbdev
*psb_fbdev
= (struct psb_fbdev
*)helper
;
574 DRM_DEBUG("%s\n", __func__
);
577 ret
= psbfb_create(psb_fbdev
, sizes
);
585 struct drm_fb_helper_funcs psb_fb_helper_funcs
= {
586 .gamma_set
= psbfb_gamma_set
,
587 .gamma_get
= psbfb_gamma_get
,
588 .fb_probe
= psbfb_probe
,
591 int psb_fbdev_destroy(struct drm_device
*dev
, struct psb_fbdev
*fbdev
)
593 struct fb_info
*info
;
594 struct psb_framebuffer
*psbfb
= fbdev
->pfb
;
596 if (fbdev
->psb_fb_helper
.fbdev
) {
597 info
= fbdev
->psb_fb_helper
.fbdev
;
598 psb_gtt_free_range(dev
, psbfb
->mem
);
599 unregister_framebuffer(info
);
600 iounmap(info
->screen_base
);
601 framebuffer_release(info
);
604 drm_fb_helper_fini(&fbdev
->psb_fb_helper
);
605 drm_framebuffer_cleanup(&psbfb
->base
);
609 int psb_fbdev_init(struct drm_device
*dev
)
611 struct psb_fbdev
*fbdev
;
612 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
615 fbdev
= kzalloc(sizeof(struct psb_fbdev
), GFP_KERNEL
);
617 DRM_ERROR("no memory\n");
621 dev_priv
->fbdev
= fbdev
;
622 fbdev
->psb_fb_helper
.funcs
= &psb_fb_helper_funcs
;
626 drm_fb_helper_init(dev
, &fbdev
->psb_fb_helper
, num_crtc
,
629 drm_fb_helper_single_add_all_connectors(&fbdev
->psb_fb_helper
);
630 drm_fb_helper_initial_config(&fbdev
->psb_fb_helper
, 32);
634 void psb_fbdev_fini(struct drm_device
*dev
)
636 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
638 if (!dev_priv
->fbdev
)
641 psb_fbdev_destroy(dev
, dev_priv
->fbdev
);
642 kfree(dev_priv
->fbdev
);
643 dev_priv
->fbdev
= NULL
;
647 static void psbfb_output_poll_changed(struct drm_device
*dev
)
649 struct drm_psb_private
*dev_priv
= dev
->dev_private
;
650 struct psb_fbdev
*fbdev
= (struct psb_fbdev
*)dev_priv
->fbdev
;
651 drm_fb_helper_hotplug_event(&fbdev
->psb_fb_helper
);
654 int psbfb_remove(struct drm_device
*dev
, struct drm_framebuffer
*fb
)
656 struct fb_info
*info
;
657 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
665 framebuffer_release(info
);
668 /*EXPORT_SYMBOL(psbfb_remove); */
670 static int psb_user_framebuffer_create_handle(struct drm_framebuffer
*fb
,
671 struct drm_file
*file_priv
,
672 unsigned int *handle
)
674 /* JB: TODO currently we can't go from a bo to a handle with ttm */
680 static void psb_user_framebuffer_destroy(struct drm_framebuffer
*fb
)
682 struct drm_device
*dev
= fb
->dev
;
683 struct psb_framebuffer
*psbfb
= to_psb_fb(fb
);
686 psb_gtt_unmap_meminfo(dev
, psbfb
->hKernelMemInfo
);
688 psbfb_remove(dev
, fb
);
690 /* JB: TODO not drop, refcount buffer */
691 drm_framebuffer_cleanup(fb
);
695 static const struct drm_mode_config_funcs psb_mode_funcs
= {
696 .fb_create
= psb_user_framebuffer_create
,
697 .output_poll_changed
= psbfb_output_poll_changed
,
700 static int psb_create_backlight_property(struct drm_device
*dev
)
702 struct drm_psb_private
*dev_priv
703 = (struct drm_psb_private
*) dev
->dev_private
;
704 struct drm_property
*backlight
;
706 if (dev_priv
->backlight_property
)
709 backlight
= drm_property_create(dev
,
713 backlight
->values
[0] = 0;
714 backlight
->values
[1] = 100;
716 dev_priv
->backlight_property
= backlight
;
721 static void psb_setup_outputs(struct drm_device
*dev
)
723 struct drm_psb_private
*dev_priv
=
724 (struct drm_psb_private
*) dev
->dev_private
;
725 struct drm_connector
*connector
;
727 PSB_DEBUG_ENTRY("\n");
729 drm_mode_create_scaling_mode_property(dev
);
731 psb_create_backlight_property(dev
);
734 if (dev_priv
->iLVDS_enable
)
735 mrst_lvds_init(dev
, &dev_priv
->mode_dev
);
737 DRM_ERROR("DSI is not supported\n");
739 psb_intel_lvds_init(dev
, &dev_priv
->mode_dev
);
740 psb_intel_sdvo_init(dev
, SDVOB
);
743 list_for_each_entry(connector
, &dev
->mode_config
.connector_list
,
745 struct psb_intel_output
*psb_intel_output
=
746 to_psb_intel_output(connector
);
747 struct drm_encoder
*encoder
= &psb_intel_output
->enc
;
748 int crtc_mask
= 0, clone_mask
= 0;
751 switch (psb_intel_output
->type
) {
752 case INTEL_OUTPUT_SDVO
:
753 crtc_mask
= ((1 << 0) | (1 << 1));
754 clone_mask
= (1 << INTEL_OUTPUT_SDVO
);
756 case INTEL_OUTPUT_LVDS
:
757 PSB_DEBUG_ENTRY("LVDS.\n");
759 crtc_mask
= (1 << 0);
761 crtc_mask
= (1 << 1);
762 clone_mask
= (1 << INTEL_OUTPUT_LVDS
);
764 case INTEL_OUTPUT_MIPI
:
765 PSB_DEBUG_ENTRY("MIPI.\n");
766 crtc_mask
= (1 << 0);
767 clone_mask
= (1 << INTEL_OUTPUT_MIPI
);
769 case INTEL_OUTPUT_MIPI2
:
770 PSB_DEBUG_ENTRY("MIPI2.\n");
771 crtc_mask
= (1 << 2);
772 clone_mask
= (1 << INTEL_OUTPUT_MIPI2
);
774 case INTEL_OUTPUT_HDMI
:
775 PSB_DEBUG_ENTRY("HDMI.\n");
776 crtc_mask
= (1 << 1);
777 clone_mask
= (1 << INTEL_OUTPUT_HDMI
);
781 encoder
->possible_crtcs
= crtc_mask
;
782 encoder
->possible_clones
=
783 psb_intel_connector_clones(dev
, clone_mask
);
788 static void *psb_bo_from_handle(struct drm_device
*dev
,
789 struct drm_file
*file_priv
,
792 void *psKernelMemInfo
= NULL
;
793 void * hKernelMemInfo
= (void *)handle
;
796 ret
= psb_get_meminfo_by_handle(hKernelMemInfo
, &psKernelMemInfo
);
798 DRM_ERROR("Cannot get meminfo for handle 0x%x\n",
799 (u32
)hKernelMemInfo
);
803 return (void *)psKernelMemInfo
;
806 static size_t psb_bo_size(struct drm_device
*dev
, void *bof
)
809 void *psKernelMemInfo
= (void *)bof
;
810 return (size_t)psKernelMemInfo
->ui32AllocSize
;
816 static size_t psb_bo_offset(struct drm_device
*dev
, void *bof
)
818 struct psb_framebuffer
*psbfb
819 = (struct psb_framebuffer
*)bof
;
821 return (size_t)psbfb
->offset
;
824 static int psb_bo_pin_for_scanout(struct drm_device
*dev
, void *bo
)
829 static int psb_bo_unpin_for_scanout(struct drm_device
*dev
, void *bo
)
834 void psb_modeset_init(struct drm_device
*dev
)
836 struct drm_psb_private
*dev_priv
=
837 (struct drm_psb_private
*) dev
->dev_private
;
838 struct psb_intel_mode_device
*mode_dev
= &dev_priv
->mode_dev
;
841 PSB_DEBUG_ENTRY("\n");
842 /* Init mm functions */
843 mode_dev
->bo_from_handle
= psb_bo_from_handle
;
844 mode_dev
->bo_size
= psb_bo_size
;
845 mode_dev
->bo_offset
= psb_bo_offset
;
846 mode_dev
->bo_pin_for_scanout
= psb_bo_pin_for_scanout
;
847 mode_dev
->bo_unpin_for_scanout
= psb_bo_unpin_for_scanout
;
849 drm_mode_config_init(dev
);
851 dev
->mode_config
.min_width
= 0;
852 dev
->mode_config
.min_height
= 0;
854 dev
->mode_config
.funcs
= (void *) &psb_mode_funcs
;
856 /* set memory base */
857 /* MRST and PSB should use BAR 2*/
858 pci_read_config_dword(dev
->pdev
, PSB_BSM
, (u32
*)
859 &(dev
->mode_config
.fb_base
));
861 /* num pipes is 2 for PSB but 1 for Mrst */
862 for (i
= 0; i
< dev_priv
->num_pipe
; i
++)
863 psb_intel_crtc_init(dev
, i
, mode_dev
);
865 dev
->mode_config
.max_width
= 2048;
866 dev
->mode_config
.max_height
= 2048;
868 psb_setup_outputs(dev
);
871 /* drm_initial_config(dev); */
874 void psb_modeset_cleanup(struct drm_device
*dev
)
876 mutex_lock(&dev
->struct_mutex
);
878 drm_kms_helper_poll_fini(dev
);
881 drm_mode_config_cleanup(dev
);
883 mutex_unlock(&dev
->struct_mutex
);