Merge tag 'for-linus-4.11-rc1-tag' of git://git.kernel.org/pub/scm/linux/kernel/git...
[sfrench/cifs-2.6.git] / drivers / gpu / drm / i915 / i915_gem_stolen.c
1 /*
2  * Copyright © 2008-2012 Intel Corporation
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice (including the next
12  * paragraph) shall be included in all copies or substantial portions of the
13  * Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
21  * IN THE SOFTWARE.
22  *
23  * Authors:
24  *    Eric Anholt <eric@anholt.net>
25  *    Chris Wilson <chris@chris-wilson.co.uk>
26  *
27  */
28
29 #include <drm/drmP.h>
30 #include <drm/i915_drm.h>
31 #include "i915_drv.h"
32
33 #define KB(x) ((x) * 1024)
34 #define MB(x) (KB(x) * 1024)
35
36 /*
37  * The BIOS typically reserves some of the system's memory for the exclusive
38  * use of the integrated graphics. This memory is no longer available for
39  * use by the OS and so the user finds that his system has less memory
40  * available than he put in. We refer to this memory as stolen.
41  *
42  * The BIOS will allocate its framebuffer from the stolen memory. Our
43  * goal is try to reuse that object for our own fbcon which must always
44  * be available for panics. Anything else we can reuse the stolen memory
45  * for is a boon.
46  */
47
48 int i915_gem_stolen_insert_node_in_range(struct drm_i915_private *dev_priv,
49                                          struct drm_mm_node *node, u64 size,
50                                          unsigned alignment, u64 start, u64 end)
51 {
52         int ret;
53
54         if (!drm_mm_initialized(&dev_priv->mm.stolen))
55                 return -ENODEV;
56
57         mutex_lock(&dev_priv->mm.stolen_lock);
58         ret = drm_mm_insert_node_in_range(&dev_priv->mm.stolen, node,
59                                           size, alignment, 0,
60                                           start, end, DRM_MM_INSERT_BEST);
61         mutex_unlock(&dev_priv->mm.stolen_lock);
62
63         return ret;
64 }
65
66 int i915_gem_stolen_insert_node(struct drm_i915_private *dev_priv,
67                                 struct drm_mm_node *node, u64 size,
68                                 unsigned alignment)
69 {
70         return i915_gem_stolen_insert_node_in_range(dev_priv, node, size,
71                                                     alignment, 0, U64_MAX);
72 }
73
74 void i915_gem_stolen_remove_node(struct drm_i915_private *dev_priv,
75                                  struct drm_mm_node *node)
76 {
77         mutex_lock(&dev_priv->mm.stolen_lock);
78         drm_mm_remove_node(node);
79         mutex_unlock(&dev_priv->mm.stolen_lock);
80 }
81
82 static unsigned long i915_stolen_to_physical(struct drm_i915_private *dev_priv)
83 {
84         struct pci_dev *pdev = dev_priv->drm.pdev;
85         struct i915_ggtt *ggtt = &dev_priv->ggtt;
86         struct resource *r;
87         u32 base;
88
89         /* Almost universally we can find the Graphics Base of Stolen Memory
90          * at register BSM (0x5c) in the igfx configuration space. On a few
91          * (desktop) machines this is also mirrored in the bridge device at
92          * different locations, or in the MCHBAR.
93          *
94          * On 865 we just check the TOUD register.
95          *
96          * On 830/845/85x the stolen memory base isn't available in any
97          * register. We need to calculate it as TOM-TSEG_SIZE-stolen_size.
98          *
99          */
100         base = 0;
101         if (INTEL_GEN(dev_priv) >= 3) {
102                 u32 bsm;
103
104                 pci_read_config_dword(pdev, INTEL_BSM, &bsm);
105
106                 base = bsm & INTEL_BSM_MASK;
107         } else if (IS_I865G(dev_priv)) {
108                 u32 tseg_size = 0;
109                 u16 toud = 0;
110                 u8 tmp;
111
112                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 0),
113                                          I845_ESMRAMC, &tmp);
114
115                 if (tmp & TSEG_ENABLE) {
116                         switch (tmp & I845_TSEG_SIZE_MASK) {
117                         case I845_TSEG_SIZE_512K:
118                                 tseg_size = KB(512);
119                                 break;
120                         case I845_TSEG_SIZE_1M:
121                                 tseg_size = MB(1);
122                                 break;
123                         }
124                 }
125
126                 pci_bus_read_config_word(pdev->bus, PCI_DEVFN(0, 0),
127                                          I865_TOUD, &toud);
128
129                 base = (toud << 16) + tseg_size;
130         } else if (IS_I85X(dev_priv)) {
131                 u32 tseg_size = 0;
132                 u32 tom;
133                 u8 tmp;
134
135                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 0),
136                                          I85X_ESMRAMC, &tmp);
137
138                 if (tmp & TSEG_ENABLE)
139                         tseg_size = MB(1);
140
141                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 1),
142                                          I85X_DRB3, &tmp);
143                 tom = tmp * MB(32);
144
145                 base = tom - tseg_size - ggtt->stolen_size;
146         } else if (IS_I845G(dev_priv)) {
147                 u32 tseg_size = 0;
148                 u32 tom;
149                 u8 tmp;
150
151                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 0),
152                                          I845_ESMRAMC, &tmp);
153
154                 if (tmp & TSEG_ENABLE) {
155                         switch (tmp & I845_TSEG_SIZE_MASK) {
156                         case I845_TSEG_SIZE_512K:
157                                 tseg_size = KB(512);
158                                 break;
159                         case I845_TSEG_SIZE_1M:
160                                 tseg_size = MB(1);
161                                 break;
162                         }
163                 }
164
165                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 0),
166                                          I830_DRB3, &tmp);
167                 tom = tmp * MB(32);
168
169                 base = tom - tseg_size - ggtt->stolen_size;
170         } else if (IS_I830(dev_priv)) {
171                 u32 tseg_size = 0;
172                 u32 tom;
173                 u8 tmp;
174
175                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 0),
176                                          I830_ESMRAMC, &tmp);
177
178                 if (tmp & TSEG_ENABLE) {
179                         if (tmp & I830_TSEG_SIZE_1M)
180                                 tseg_size = MB(1);
181                         else
182                                 tseg_size = KB(512);
183                 }
184
185                 pci_bus_read_config_byte(pdev->bus, PCI_DEVFN(0, 0),
186                                          I830_DRB3, &tmp);
187                 tom = tmp * MB(32);
188
189                 base = tom - tseg_size - ggtt->stolen_size;
190         }
191
192         if (base == 0)
193                 return 0;
194
195         /* make sure we don't clobber the GTT if it's within stolen memory */
196         if (INTEL_GEN(dev_priv) <= 4 &&
197             !IS_G33(dev_priv) && !IS_PINEVIEW(dev_priv) && !IS_G4X(dev_priv)) {
198                 struct {
199                         u32 start, end;
200                 } stolen[2] = {
201                         { .start = base, .end = base + ggtt->stolen_size, },
202                         { .start = base, .end = base + ggtt->stolen_size, },
203                 };
204                 u64 ggtt_start, ggtt_end;
205
206                 ggtt_start = I915_READ(PGTBL_CTL);
207                 if (IS_GEN4(dev_priv))
208                         ggtt_start = (ggtt_start & PGTBL_ADDRESS_LO_MASK) |
209                                      (ggtt_start & PGTBL_ADDRESS_HI_MASK) << 28;
210                 else
211                         ggtt_start &= PGTBL_ADDRESS_LO_MASK;
212                 ggtt_end = ggtt_start + ggtt_total_entries(ggtt) * 4;
213
214                 if (ggtt_start >= stolen[0].start && ggtt_start < stolen[0].end)
215                         stolen[0].end = ggtt_start;
216                 if (ggtt_end > stolen[1].start && ggtt_end <= stolen[1].end)
217                         stolen[1].start = ggtt_end;
218
219                 /* pick the larger of the two chunks */
220                 if (stolen[0].end - stolen[0].start >
221                     stolen[1].end - stolen[1].start) {
222                         base = stolen[0].start;
223                         ggtt->stolen_size = stolen[0].end - stolen[0].start;
224                 } else {
225                         base = stolen[1].start;
226                         ggtt->stolen_size = stolen[1].end - stolen[1].start;
227                 }
228
229                 if (stolen[0].start != stolen[1].start ||
230                     stolen[0].end != stolen[1].end) {
231                         DRM_DEBUG_KMS("GTT within stolen memory at 0x%llx-0x%llx\n",
232                                       (unsigned long long)ggtt_start,
233                                       (unsigned long long)ggtt_end - 1);
234                         DRM_DEBUG_KMS("Stolen memory adjusted to 0x%x-0x%x\n",
235                                       base, base + (u32)ggtt->stolen_size - 1);
236                 }
237         }
238
239
240         /* Verify that nothing else uses this physical address. Stolen
241          * memory should be reserved by the BIOS and hidden from the
242          * kernel. So if the region is already marked as busy, something
243          * is seriously wrong.
244          */
245         r = devm_request_mem_region(dev_priv->drm.dev, base, ggtt->stolen_size,
246                                     "Graphics Stolen Memory");
247         if (r == NULL) {
248                 /*
249                  * One more attempt but this time requesting region from
250                  * base + 1, as we have seen that this resolves the region
251                  * conflict with the PCI Bus.
252                  * This is a BIOS w/a: Some BIOS wrap stolen in the root
253                  * PCI bus, but have an off-by-one error. Hence retry the
254                  * reservation starting from 1 instead of 0.
255                  */
256                 r = devm_request_mem_region(dev_priv->drm.dev, base + 1,
257                                             ggtt->stolen_size - 1,
258                                             "Graphics Stolen Memory");
259                 /*
260                  * GEN3 firmware likes to smash pci bridges into the stolen
261                  * range. Apparently this works.
262                  */
263                 if (r == NULL && !IS_GEN3(dev_priv)) {
264                         DRM_ERROR("conflict detected with stolen region: [0x%08x - 0x%08x]\n",
265                                   base, base + (uint32_t)ggtt->stolen_size);
266                         base = 0;
267                 }
268         }
269
270         return base;
271 }
272
273 void i915_gem_cleanup_stolen(struct drm_device *dev)
274 {
275         struct drm_i915_private *dev_priv = to_i915(dev);
276
277         if (!drm_mm_initialized(&dev_priv->mm.stolen))
278                 return;
279
280         drm_mm_takedown(&dev_priv->mm.stolen);
281 }
282
283 static void g4x_get_stolen_reserved(struct drm_i915_private *dev_priv,
284                                     phys_addr_t *base, u32 *size)
285 {
286         struct i915_ggtt *ggtt = &dev_priv->ggtt;
287         uint32_t reg_val = I915_READ(IS_GM45(dev_priv) ?
288                                      CTG_STOLEN_RESERVED :
289                                      ELK_STOLEN_RESERVED);
290         phys_addr_t stolen_top = dev_priv->mm.stolen_base + ggtt->stolen_size;
291
292         *base = (reg_val & G4X_STOLEN_RESERVED_ADDR2_MASK) << 16;
293
294         WARN_ON((reg_val & G4X_STOLEN_RESERVED_ADDR1_MASK) < *base);
295
296         /* On these platforms, the register doesn't have a size field, so the
297          * size is the distance between the base and the top of the stolen
298          * memory. We also have the genuine case where base is zero and there's
299          * nothing reserved. */
300         if (*base == 0)
301                 *size = 0;
302         else
303                 *size = stolen_top - *base;
304 }
305
306 static void gen6_get_stolen_reserved(struct drm_i915_private *dev_priv,
307                                      phys_addr_t *base, u32 *size)
308 {
309         uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);
310
311         *base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;
312
313         switch (reg_val & GEN6_STOLEN_RESERVED_SIZE_MASK) {
314         case GEN6_STOLEN_RESERVED_1M:
315                 *size = 1024 * 1024;
316                 break;
317         case GEN6_STOLEN_RESERVED_512K:
318                 *size = 512 * 1024;
319                 break;
320         case GEN6_STOLEN_RESERVED_256K:
321                 *size = 256 * 1024;
322                 break;
323         case GEN6_STOLEN_RESERVED_128K:
324                 *size = 128 * 1024;
325                 break;
326         default:
327                 *size = 1024 * 1024;
328                 MISSING_CASE(reg_val & GEN6_STOLEN_RESERVED_SIZE_MASK);
329         }
330 }
331
332 static void gen7_get_stolen_reserved(struct drm_i915_private *dev_priv,
333                                      phys_addr_t *base, u32 *size)
334 {
335         uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);
336
337         *base = reg_val & GEN7_STOLEN_RESERVED_ADDR_MASK;
338
339         switch (reg_val & GEN7_STOLEN_RESERVED_SIZE_MASK) {
340         case GEN7_STOLEN_RESERVED_1M:
341                 *size = 1024 * 1024;
342                 break;
343         case GEN7_STOLEN_RESERVED_256K:
344                 *size = 256 * 1024;
345                 break;
346         default:
347                 *size = 1024 * 1024;
348                 MISSING_CASE(reg_val & GEN7_STOLEN_RESERVED_SIZE_MASK);
349         }
350 }
351
352 static void chv_get_stolen_reserved(struct drm_i915_private *dev_priv,
353                                     phys_addr_t *base, u32 *size)
354 {
355         uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);
356
357         *base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;
358
359         switch (reg_val & GEN8_STOLEN_RESERVED_SIZE_MASK) {
360         case GEN8_STOLEN_RESERVED_1M:
361                 *size = 1024 * 1024;
362                 break;
363         case GEN8_STOLEN_RESERVED_2M:
364                 *size = 2 * 1024 * 1024;
365                 break;
366         case GEN8_STOLEN_RESERVED_4M:
367                 *size = 4 * 1024 * 1024;
368                 break;
369         case GEN8_STOLEN_RESERVED_8M:
370                 *size = 8 * 1024 * 1024;
371                 break;
372         default:
373                 *size = 8 * 1024 * 1024;
374                 MISSING_CASE(reg_val & GEN8_STOLEN_RESERVED_SIZE_MASK);
375         }
376 }
377
378 static void bdw_get_stolen_reserved(struct drm_i915_private *dev_priv,
379                                     phys_addr_t *base, u32 *size)
380 {
381         struct i915_ggtt *ggtt = &dev_priv->ggtt;
382         uint32_t reg_val = I915_READ(GEN6_STOLEN_RESERVED);
383         phys_addr_t stolen_top;
384
385         stolen_top = dev_priv->mm.stolen_base + ggtt->stolen_size;
386
387         *base = reg_val & GEN6_STOLEN_RESERVED_ADDR_MASK;
388
389         /* On these platforms, the register doesn't have a size field, so the
390          * size is the distance between the base and the top of the stolen
391          * memory. We also have the genuine case where base is zero and there's
392          * nothing reserved. */
393         if (*base == 0)
394                 *size = 0;
395         else
396                 *size = stolen_top - *base;
397 }
398
399 int i915_gem_init_stolen(struct drm_i915_private *dev_priv)
400 {
401         struct i915_ggtt *ggtt = &dev_priv->ggtt;
402         phys_addr_t reserved_base, stolen_top;
403         u32 reserved_total, reserved_size;
404         u32 stolen_usable_start;
405
406         mutex_init(&dev_priv->mm.stolen_lock);
407
408         if (intel_vgpu_active(dev_priv)) {
409                 DRM_INFO("iGVT-g active, disabling use of stolen memory\n");
410                 return 0;
411         }
412
413 #ifdef CONFIG_INTEL_IOMMU
414         if (intel_iommu_gfx_mapped && INTEL_GEN(dev_priv) < 8) {
415                 DRM_INFO("DMAR active, disabling use of stolen memory\n");
416                 return 0;
417         }
418 #endif
419
420         if (ggtt->stolen_size == 0)
421                 return 0;
422
423         dev_priv->mm.stolen_base = i915_stolen_to_physical(dev_priv);
424         if (dev_priv->mm.stolen_base == 0)
425                 return 0;
426
427         stolen_top = dev_priv->mm.stolen_base + ggtt->stolen_size;
428         reserved_base = 0;
429         reserved_size = 0;
430
431         switch (INTEL_INFO(dev_priv)->gen) {
432         case 2:
433         case 3:
434                 break;
435         case 4:
436                 if (IS_G4X(dev_priv))
437                         g4x_get_stolen_reserved(dev_priv,
438                                                 &reserved_base, &reserved_size);
439                 break;
440         case 5:
441                 /* Assume the gen6 maximum for the older platforms. */
442                 reserved_size = 1024 * 1024;
443                 reserved_base = stolen_top - reserved_size;
444                 break;
445         case 6:
446                 gen6_get_stolen_reserved(dev_priv,
447                                          &reserved_base, &reserved_size);
448                 break;
449         case 7:
450                 gen7_get_stolen_reserved(dev_priv,
451                                          &reserved_base, &reserved_size);
452                 break;
453         default:
454                 if (IS_LP(dev_priv))
455                         chv_get_stolen_reserved(dev_priv,
456                                                 &reserved_base, &reserved_size);
457                 else
458                         bdw_get_stolen_reserved(dev_priv,
459                                                 &reserved_base, &reserved_size);
460                 break;
461         }
462
463         /* It is possible for the reserved base to be zero, but the register
464          * field for size doesn't have a zero option. */
465         if (reserved_base == 0) {
466                 reserved_size = 0;
467                 reserved_base = stolen_top;
468         }
469
470         if (reserved_base < dev_priv->mm.stolen_base ||
471             reserved_base + reserved_size > stolen_top) {
472                 phys_addr_t reserved_top = reserved_base + reserved_size;
473                 DRM_DEBUG_KMS("Stolen reserved area [%pa - %pa] outside stolen memory [%pa - %pa]\n",
474                               &reserved_base, &reserved_top,
475                               &dev_priv->mm.stolen_base, &stolen_top);
476                 return 0;
477         }
478
479         ggtt->stolen_reserved_base = reserved_base;
480         ggtt->stolen_reserved_size = reserved_size;
481
482         /* It is possible for the reserved area to end before the end of stolen
483          * memory, so just consider the start. */
484         reserved_total = stolen_top - reserved_base;
485
486         DRM_DEBUG_KMS("Memory reserved for graphics device: %uK, usable: %uK\n",
487                       ggtt->stolen_size >> 10,
488                       (ggtt->stolen_size - reserved_total) >> 10);
489
490         stolen_usable_start = 0;
491         /* WaSkipStolenMemoryFirstPage:bdw+ */
492         if (INTEL_GEN(dev_priv) >= 8)
493                 stolen_usable_start = 4096;
494
495         ggtt->stolen_usable_size =
496                 ggtt->stolen_size - reserved_total - stolen_usable_start;
497
498         /* Basic memrange allocator for stolen space. */
499         drm_mm_init(&dev_priv->mm.stolen, stolen_usable_start,
500                     ggtt->stolen_usable_size);
501
502         return 0;
503 }
504
505 static struct sg_table *
506 i915_pages_create_for_stolen(struct drm_device *dev,
507                              u32 offset, u32 size)
508 {
509         struct drm_i915_private *dev_priv = to_i915(dev);
510         struct sg_table *st;
511         struct scatterlist *sg;
512
513         GEM_BUG_ON(range_overflows(offset, size, dev_priv->ggtt.stolen_size));
514
515         /* We hide that we have no struct page backing our stolen object
516          * by wrapping the contiguous physical allocation with a fake
517          * dma mapping in a single scatterlist.
518          */
519
520         st = kmalloc(sizeof(*st), GFP_KERNEL);
521         if (st == NULL)
522                 return ERR_PTR(-ENOMEM);
523
524         if (sg_alloc_table(st, 1, GFP_KERNEL)) {
525                 kfree(st);
526                 return ERR_PTR(-ENOMEM);
527         }
528
529         sg = st->sgl;
530         sg->offset = 0;
531         sg->length = size;
532
533         sg_dma_address(sg) = (dma_addr_t)dev_priv->mm.stolen_base + offset;
534         sg_dma_len(sg) = size;
535
536         return st;
537 }
538
539 static struct sg_table *
540 i915_gem_object_get_pages_stolen(struct drm_i915_gem_object *obj)
541 {
542         return i915_pages_create_for_stolen(obj->base.dev,
543                                             obj->stolen->start,
544                                             obj->stolen->size);
545 }
546
547 static void i915_gem_object_put_pages_stolen(struct drm_i915_gem_object *obj,
548                                              struct sg_table *pages)
549 {
550         /* Should only be called from i915_gem_object_release_stolen() */
551         sg_free_table(pages);
552         kfree(pages);
553 }
554
555 static void
556 i915_gem_object_release_stolen(struct drm_i915_gem_object *obj)
557 {
558         struct drm_i915_private *dev_priv = to_i915(obj->base.dev);
559         struct drm_mm_node *stolen = fetch_and_zero(&obj->stolen);
560
561         GEM_BUG_ON(!stolen);
562
563         __i915_gem_object_unpin_pages(obj);
564
565         i915_gem_stolen_remove_node(dev_priv, stolen);
566         kfree(stolen);
567 }
568
569 static const struct drm_i915_gem_object_ops i915_gem_object_stolen_ops = {
570         .get_pages = i915_gem_object_get_pages_stolen,
571         .put_pages = i915_gem_object_put_pages_stolen,
572         .release = i915_gem_object_release_stolen,
573 };
574
575 static struct drm_i915_gem_object *
576 _i915_gem_object_create_stolen(struct drm_i915_private *dev_priv,
577                                struct drm_mm_node *stolen)
578 {
579         struct drm_i915_gem_object *obj;
580
581         obj = i915_gem_object_alloc(dev_priv);
582         if (obj == NULL)
583                 return NULL;
584
585         drm_gem_private_object_init(&dev_priv->drm, &obj->base, stolen->size);
586         i915_gem_object_init(obj, &i915_gem_object_stolen_ops);
587
588         obj->stolen = stolen;
589         obj->base.read_domains = I915_GEM_DOMAIN_CPU | I915_GEM_DOMAIN_GTT;
590         obj->cache_level = HAS_LLC(dev_priv) ? I915_CACHE_LLC : I915_CACHE_NONE;
591
592         if (i915_gem_object_pin_pages(obj))
593                 goto cleanup;
594
595         return obj;
596
597 cleanup:
598         i915_gem_object_free(obj);
599         return NULL;
600 }
601
602 struct drm_i915_gem_object *
603 i915_gem_object_create_stolen(struct drm_i915_private *dev_priv, u32 size)
604 {
605         struct drm_i915_gem_object *obj;
606         struct drm_mm_node *stolen;
607         int ret;
608
609         if (!drm_mm_initialized(&dev_priv->mm.stolen))
610                 return NULL;
611
612         if (size == 0)
613                 return NULL;
614
615         stolen = kzalloc(sizeof(*stolen), GFP_KERNEL);
616         if (!stolen)
617                 return NULL;
618
619         ret = i915_gem_stolen_insert_node(dev_priv, stolen, size, 4096);
620         if (ret) {
621                 kfree(stolen);
622                 return NULL;
623         }
624
625         obj = _i915_gem_object_create_stolen(dev_priv, stolen);
626         if (obj)
627                 return obj;
628
629         i915_gem_stolen_remove_node(dev_priv, stolen);
630         kfree(stolen);
631         return NULL;
632 }
633
634 struct drm_i915_gem_object *
635 i915_gem_object_create_stolen_for_preallocated(struct drm_i915_private *dev_priv,
636                                                u32 stolen_offset,
637                                                u32 gtt_offset,
638                                                u32 size)
639 {
640         struct i915_ggtt *ggtt = &dev_priv->ggtt;
641         struct drm_i915_gem_object *obj;
642         struct drm_mm_node *stolen;
643         struct i915_vma *vma;
644         int ret;
645
646         if (!drm_mm_initialized(&dev_priv->mm.stolen))
647                 return NULL;
648
649         lockdep_assert_held(&dev_priv->drm.struct_mutex);
650
651         DRM_DEBUG_KMS("creating preallocated stolen object: stolen_offset=%x, gtt_offset=%x, size=%x\n",
652                         stolen_offset, gtt_offset, size);
653
654         /* KISS and expect everything to be page-aligned */
655         if (WARN_ON(size == 0) ||
656             WARN_ON(!IS_ALIGNED(size, I915_GTT_PAGE_SIZE)) ||
657             WARN_ON(!IS_ALIGNED(stolen_offset, I915_GTT_MIN_ALIGNMENT)))
658                 return NULL;
659
660         stolen = kzalloc(sizeof(*stolen), GFP_KERNEL);
661         if (!stolen)
662                 return NULL;
663
664         stolen->start = stolen_offset;
665         stolen->size = size;
666         mutex_lock(&dev_priv->mm.stolen_lock);
667         ret = drm_mm_reserve_node(&dev_priv->mm.stolen, stolen);
668         mutex_unlock(&dev_priv->mm.stolen_lock);
669         if (ret) {
670                 DRM_DEBUG_KMS("failed to allocate stolen space\n");
671                 kfree(stolen);
672                 return NULL;
673         }
674
675         obj = _i915_gem_object_create_stolen(dev_priv, stolen);
676         if (obj == NULL) {
677                 DRM_DEBUG_KMS("failed to allocate stolen object\n");
678                 i915_gem_stolen_remove_node(dev_priv, stolen);
679                 kfree(stolen);
680                 return NULL;
681         }
682
683         /* Some objects just need physical mem from stolen space */
684         if (gtt_offset == I915_GTT_OFFSET_NONE)
685                 return obj;
686
687         ret = i915_gem_object_pin_pages(obj);
688         if (ret)
689                 goto err;
690
691         vma = i915_vma_instance(obj, &ggtt->base, NULL);
692         if (IS_ERR(vma)) {
693                 ret = PTR_ERR(vma);
694                 goto err_pages;
695         }
696
697         /* To simplify the initialisation sequence between KMS and GTT,
698          * we allow construction of the stolen object prior to
699          * setting up the GTT space. The actual reservation will occur
700          * later.
701          */
702         ret = i915_gem_gtt_reserve(&ggtt->base, &vma->node,
703                                    size, gtt_offset, obj->cache_level,
704                                    0);
705         if (ret) {
706                 DRM_DEBUG_KMS("failed to allocate stolen GTT space\n");
707                 goto err_pages;
708         }
709
710         GEM_BUG_ON(!drm_mm_node_allocated(&vma->node));
711
712         vma->pages = obj->mm.pages;
713         vma->flags |= I915_VMA_GLOBAL_BIND;
714         __i915_vma_set_map_and_fenceable(vma);
715         list_move_tail(&vma->vm_link, &ggtt->base.inactive_list);
716         list_move_tail(&obj->global_link, &dev_priv->mm.bound_list);
717         obj->bind_count++;
718
719         return obj;
720
721 err_pages:
722         i915_gem_object_unpin_pages(obj);
723 err:
724         i915_gem_object_put(obj);
725         return NULL;
726 }