2 * Copyright 2010 Matt Turner.
3 * Copyright 2012 Red Hat
5 * This file is subject to the terms and conditions of the GNU General
6 * Public License version 2. See the file COPYING in the main
7 * directory of this archive for more details.
9 * Authors: Matthew Garrett
14 #include "drm_crtc_helper.h"
15 #include "mgag200_drv.h"
17 static void mga_user_framebuffer_destroy(struct drm_framebuffer *fb)
19 struct mga_framebuffer *mga_fb = to_mga_framebuffer(fb);
21 drm_gem_object_unreference_unlocked(mga_fb->obj);
22 drm_framebuffer_cleanup(fb);
26 static int mga_user_framebuffer_create_handle(struct drm_framebuffer *fb,
27 struct drm_file *file_priv,
33 static const struct drm_framebuffer_funcs mga_fb_funcs = {
34 .destroy = mga_user_framebuffer_destroy,
35 .create_handle = mga_user_framebuffer_create_handle,
38 int mgag200_framebuffer_init(struct drm_device *dev,
39 struct mga_framebuffer *gfb,
40 struct drm_mode_fb_cmd2 *mode_cmd,
41 struct drm_gem_object *obj)
43 int ret = drm_framebuffer_init(dev, &gfb->base, &mga_fb_funcs);
45 DRM_ERROR("drm_framebuffer_init failed: %d\n", ret);
48 drm_helper_mode_fill_fb_struct(&gfb->base, mode_cmd);
53 static struct drm_framebuffer *
54 mgag200_user_framebuffer_create(struct drm_device *dev,
55 struct drm_file *filp,
56 struct drm_mode_fb_cmd2 *mode_cmd)
58 struct drm_gem_object *obj;
59 struct mga_framebuffer *mga_fb;
62 obj = drm_gem_object_lookup(dev, filp, mode_cmd->handles[0]);
64 return ERR_PTR(-ENOENT);
66 mga_fb = kzalloc(sizeof(*mga_fb), GFP_KERNEL);
68 drm_gem_object_unreference_unlocked(obj);
69 return ERR_PTR(-ENOMEM);
72 ret = mgag200_framebuffer_init(dev, mga_fb, mode_cmd, obj);
74 drm_gem_object_unreference_unlocked(obj);
81 static const struct drm_mode_config_funcs mga_mode_funcs = {
82 .fb_create = mgag200_user_framebuffer_create,
85 /* Unmap the framebuffer from the core and release the memory */
86 static void mga_vram_fini(struct mga_device *mdev)
88 pci_iounmap(mdev->dev->pdev, mdev->rmmio);
90 if (mdev->mc.vram_base)
91 release_mem_region(mdev->mc.vram_base, mdev->mc.vram_window);
94 static int mga_probe_vram(struct mga_device *mdev, void __iomem *mem)
102 orig = ioread16(mem);
105 for (offset = 0x100000; offset < mdev->mc.vram_window; offset += 0x4000) {
106 orig1 = ioread8(mem + offset);
107 orig2 = ioread8(mem + offset + 0x100);
109 iowrite16(0xaa55, mem + offset);
110 iowrite16(0xaa55, mem + offset + 0x100);
112 test1 = ioread16(mem + offset);
113 test2 = ioread16(mem);
115 iowrite16(orig1, mem + offset);
116 iowrite16(orig2, mem + offset + 0x100);
118 if (test1 != 0xaa55) {
127 iowrite16(orig, mem);
128 return offset - 65536;
131 /* Map the framebuffer from the card and configure the core */
132 static int mga_vram_init(struct mga_device *mdev)
135 struct apertures_struct *aper = alloc_apertures(1);
138 mdev->mc.vram_base = pci_resource_start(mdev->dev->pdev, 0);
139 mdev->mc.vram_window = pci_resource_len(mdev->dev->pdev, 0);
141 aper->ranges[0].base = mdev->mc.vram_base;
142 aper->ranges[0].size = mdev->mc.vram_window;
145 remove_conflicting_framebuffers(aper, "mgafb", true);
147 if (!request_mem_region(mdev->mc.vram_base, mdev->mc.vram_window,
149 DRM_ERROR("can't reserve VRAM\n");
153 mem = pci_iomap(mdev->dev->pdev, 0, 0);
155 mdev->mc.vram_size = mga_probe_vram(mdev, mem);
157 pci_iounmap(mdev->dev->pdev, mem);
162 static int mgag200_device_init(struct drm_device *dev,
165 struct mga_device *mdev = dev->dev_private;
170 /* Hardcode the number of CRTCs to 1 */
173 pci_read_config_dword(dev->pdev, PCI_MGA_OPTION, &option);
174 mdev->has_sdram = !(option & (1 << 14));
176 /* BAR 0 is the framebuffer, BAR 1 contains registers */
177 mdev->rmmio_base = pci_resource_start(mdev->dev->pdev, 1);
178 mdev->rmmio_size = pci_resource_len(mdev->dev->pdev, 1);
180 if (!request_mem_region(mdev->rmmio_base, mdev->rmmio_size,
182 DRM_ERROR("can't reserve mmio registers\n");
186 mdev->rmmio = pci_iomap(dev->pdev, 1, 0);
187 if (mdev->rmmio == NULL)
190 /* stash G200 SE model number for later use */
191 if (IS_G200_SE(mdev))
192 mdev->reg_1e24 = RREG32(0x1e24);
194 ret = mga_vram_init(mdev);
196 release_mem_region(mdev->rmmio_base, mdev->rmmio_size);
200 mdev->bpp_shifts[0] = 0;
201 mdev->bpp_shifts[1] = 1;
202 mdev->bpp_shifts[2] = 0;
203 mdev->bpp_shifts[3] = 2;
207 void mgag200_device_fini(struct mga_device *mdev)
209 release_mem_region(mdev->rmmio_base, mdev->rmmio_size);
214 * Functions here will be called by the core once it's bound the driver to
219 int mgag200_driver_load(struct drm_device *dev, unsigned long flags)
221 struct mga_device *mdev;
224 mdev = kzalloc(sizeof(struct mga_device), GFP_KERNEL);
227 dev->dev_private = (void *)mdev;
230 r = mgag200_device_init(dev, flags);
232 dev_err(&dev->pdev->dev, "Fatal error during GPU init: %d\n", r);
235 r = mgag200_mm_init(mdev);
239 drm_mode_config_init(dev);
240 dev->mode_config.funcs = (void *)&mga_mode_funcs;
241 dev->mode_config.min_width = 0;
242 dev->mode_config.min_height = 0;
243 dev->mode_config.preferred_depth = 24;
244 dev->mode_config.prefer_shadow = 1;
246 r = mgag200_modeset_init(mdev);
248 dev_err(&dev->pdev->dev, "Fatal error during modeset init: %d\n", r);
251 mgag200_driver_unload(dev);
255 int mgag200_driver_unload(struct drm_device *dev)
257 struct mga_device *mdev = dev->dev_private;
261 mgag200_modeset_fini(mdev);
262 mgag200_fbdev_fini(mdev);
263 drm_mode_config_cleanup(dev);
264 mgag200_mm_fini(mdev);
265 mgag200_device_fini(mdev);
267 dev->dev_private = NULL;
271 int mgag200_gem_create(struct drm_device *dev,
272 u32 size, bool iskernel,
273 struct drm_gem_object **obj)
275 struct mgag200_bo *astbo;
280 size = roundup(size, PAGE_SIZE);
284 ret = mgag200_bo_create(dev, size, 0, 0, &astbo);
286 if (ret != -ERESTARTSYS)
287 DRM_ERROR("failed to allocate GEM object\n");
294 int mgag200_dumb_create(struct drm_file *file,
295 struct drm_device *dev,
296 struct drm_mode_create_dumb *args)
299 struct drm_gem_object *gobj;
302 args->pitch = args->width * ((args->bpp + 7) / 8);
303 args->size = args->pitch * args->height;
305 ret = mgag200_gem_create(dev, args->size, false,
310 ret = drm_gem_handle_create(file, gobj, &handle);
311 drm_gem_object_unreference_unlocked(gobj);
315 args->handle = handle;
319 int mgag200_dumb_destroy(struct drm_file *file,
320 struct drm_device *dev,
323 return drm_gem_handle_delete(file, handle);
326 int mgag200_gem_init_object(struct drm_gem_object *obj)
332 void mgag200_bo_unref(struct mgag200_bo **bo)
334 struct ttm_buffer_object *tbo;
346 void mgag200_gem_free_object(struct drm_gem_object *obj)
348 struct mgag200_bo *mgag200_bo = gem_to_mga_bo(obj);
352 mgag200_bo_unref(&mgag200_bo);
356 static inline u64 mgag200_bo_mmap_offset(struct mgag200_bo *bo)
358 return bo->bo.addr_space_offset;
362 mgag200_dumb_mmap_offset(struct drm_file *file,
363 struct drm_device *dev,
367 struct drm_gem_object *obj;
369 struct mgag200_bo *bo;
371 mutex_lock(&dev->struct_mutex);
372 obj = drm_gem_object_lookup(dev, file, handle);
378 bo = gem_to_mga_bo(obj);
379 *offset = mgag200_bo_mmap_offset(bo);
381 drm_gem_object_unreference(obj);
384 mutex_unlock(&dev->struct_mutex);