Subversion Repositories Kolibri OS

Rev

Rev 1246 | Rev 1275 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright 2008 Advanced Micro Devices, Inc.
  3.  * Copyright 2008 Red Hat Inc.
  4.  * Copyright 2009 Jerome Glisse.
  5.  *
  6.  * Permission is hereby granted, free of charge, to any person obtaining a
  7.  * copy of this software and associated documentation files (the "Software"),
  8.  * to deal in the Software without restriction, including without limitation
  9.  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  10.  * and/or sell copies of the Software, and to permit persons to whom the
  11.  * Software is furnished to do so, subject to the following conditions:
  12.  *
  13.  * The above copyright notice and this permission notice shall be included in
  14.  * all copies or substantial portions of the Software.
  15.  *
  16.  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17.  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18.  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  19.  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  20.  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  21.  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  22.  * OTHER DEALINGS IN THE SOFTWARE.
  23.  *
  24.  * Authors: Dave Airlie
  25.  *          Alex Deucher
  26.  *          Jerome Glisse
  27.  */
  28. //#include <linux/console.h>
  29.  
  30. #include <drm/drmP.h>
  31. #include <drm/drm_crtc_helper.h>
  32. #include <drm/radeon_drm.h>
  33. #include "radeon_reg.h"
  34. #include "radeon.h"
  35. #include "radeon_asic.h"
  36. #include "atom.h"
  37.  
  38. #include <drm/drm_pciids.h>
  39.  
  40.  
  41. int radeon_dynclks          = -1;
  42. int radeon_r4xx_atom        = 0;
  43. int radeon_agpmode          = -1;
  44. int radeon_gart_size        = 512; /* default gart size */
  45. int radeon_benchmarking     = 0;
  46. int radeon_connector_table  = 0;
  47. int radeon_tv               = 0;
  48. int radeon_modeset          = 1;
  49.  
  50. void parse_cmdline(char *cmdline, mode_t *mode, char *log, int *kms);
  51. int init_display(struct radeon_device *rdev, mode_t *mode);
  52. int init_display_kms(struct radeon_device *rdev, mode_t *mode);
  53.  
  54. int get_modes(mode_t *mode, int *count);
  55. int set_user_mode(mode_t *mode);
  56.  
  57.  
  58.  /* Legacy VGA regions */
  59. #define VGA_RSRC_NONE          0x00
  60. #define VGA_RSRC_LEGACY_IO     0x01
  61. #define VGA_RSRC_LEGACY_MEM    0x02
  62. #define VGA_RSRC_LEGACY_MASK   (VGA_RSRC_LEGACY_IO | VGA_RSRC_LEGACY_MEM)
  63. /* Non-legacy access */
  64. #define VGA_RSRC_NORMAL_IO     0x04
  65. #define VGA_RSRC_NORMAL_MEM    0x08
  66.  
  67.  
  68.  
  69. /*
  70.  * Clear GPU surface registers.
  71.  */
  72. void radeon_surface_init(struct radeon_device *rdev)
  73. {
  74.     ENTER();
  75.  
  76.     /* FIXME: check this out */
  77.     if (rdev->family < CHIP_R600) {
  78.         int i;
  79.  
  80.         for (i = 0; i < 8; i++) {
  81.             WREG32(RADEON_SURFACE0_INFO +
  82.                    i * (RADEON_SURFACE1_INFO - RADEON_SURFACE0_INFO),
  83.                    0);
  84.         }
  85.                 /* enable surfaces */
  86.                 WREG32(RADEON_SURFACE_CNTL, 0);
  87.     }
  88. }
  89.  
  90. /*
  91.  * GPU scratch registers helpers function.
  92.  */
  93. void radeon_scratch_init(struct radeon_device *rdev)
  94. {
  95.     int i;
  96.  
  97.     /* FIXME: check this out */
  98.     if (rdev->family < CHIP_R300) {
  99.         rdev->scratch.num_reg = 5;
  100.     } else {
  101.         rdev->scratch.num_reg = 7;
  102.     }
  103.     for (i = 0; i < rdev->scratch.num_reg; i++) {
  104.         rdev->scratch.free[i] = true;
  105.         rdev->scratch.reg[i] = RADEON_SCRATCH_REG0 + (i * 4);
  106.     }
  107. }
  108.  
  109. int radeon_scratch_get(struct radeon_device *rdev, uint32_t *reg)
  110. {
  111.         int i;
  112.  
  113.         for (i = 0; i < rdev->scratch.num_reg; i++) {
  114.                 if (rdev->scratch.free[i]) {
  115.                         rdev->scratch.free[i] = false;
  116.                         *reg = rdev->scratch.reg[i];
  117.                         return 0;
  118.                 }
  119.         }
  120.         return -EINVAL;
  121. }
  122.  
  123. void radeon_scratch_free(struct radeon_device *rdev, uint32_t reg)
  124. {
  125.         int i;
  126.  
  127.         for (i = 0; i < rdev->scratch.num_reg; i++) {
  128.                 if (rdev->scratch.reg[i] == reg) {
  129.                         rdev->scratch.free[i] = true;
  130.                         return;
  131.                 }
  132.         }
  133. }
  134.  
  135. /*
  136.  * MC common functions
  137.  */
  138. int radeon_mc_setup(struct radeon_device *rdev)
  139. {
  140.         uint32_t tmp;
  141.  
  142.         /* Some chips have an "issue" with the memory controller, the
  143.          * location must be aligned to the size. We just align it down,
  144.          * too bad if we walk over the top of system memory, we don't
  145.          * use DMA without a remapped anyway.
  146.          * Affected chips are rv280, all r3xx, and all r4xx, but not IGP
  147.          */
  148.         /* FGLRX seems to setup like this, VRAM a 0, then GART.
  149.          */
  150.         /*
  151.          * Note: from R6xx the address space is 40bits but here we only
  152.          * use 32bits (still have to see a card which would exhaust 4G
  153.          * address space).
  154.          */
  155.         if (rdev->mc.vram_location != 0xFFFFFFFFUL) {
  156.                 /* vram location was already setup try to put gtt after
  157.                  * if it fits */
  158.                 tmp = rdev->mc.vram_location + rdev->mc.mc_vram_size;
  159.                 tmp = (tmp + rdev->mc.gtt_size - 1) & ~(rdev->mc.gtt_size - 1);
  160.                 if ((0xFFFFFFFFUL - tmp) >= rdev->mc.gtt_size) {
  161.                         rdev->mc.gtt_location = tmp;
  162.                 } else {
  163.                         if (rdev->mc.gtt_size >= rdev->mc.vram_location) {
  164.                                 printk(KERN_ERR "[drm] GTT too big to fit "
  165.                                        "before or after vram location.\n");
  166.                                 return -EINVAL;
  167.                         }
  168.                         rdev->mc.gtt_location = 0;
  169.                 }
  170.         } else if (rdev->mc.gtt_location != 0xFFFFFFFFUL) {
  171.                 /* gtt location was already setup try to put vram before
  172.                  * if it fits */
  173.                 if (rdev->mc.mc_vram_size < rdev->mc.gtt_location) {
  174.                         rdev->mc.vram_location = 0;
  175.                 } else {
  176.                         tmp = rdev->mc.gtt_location + rdev->mc.gtt_size;
  177.                         tmp += (rdev->mc.mc_vram_size - 1);
  178.                         tmp &= ~(rdev->mc.mc_vram_size - 1);
  179.                         if ((0xFFFFFFFFUL - tmp) >= rdev->mc.mc_vram_size) {
  180.                                 rdev->mc.vram_location = tmp;
  181.                         } else {
  182.                                 printk(KERN_ERR "[drm] vram too big to fit "
  183.                                        "before or after GTT location.\n");
  184.                                 return -EINVAL;
  185.                         }
  186.                 }
  187.         } else {
  188.                 rdev->mc.vram_location = 0;
  189.                 tmp = rdev->mc.mc_vram_size;
  190.                 tmp = (tmp + rdev->mc.gtt_size - 1) & ~(rdev->mc.gtt_size - 1);
  191.                 rdev->mc.gtt_location = tmp;
  192.         }
  193.         rdev->mc.vram_start = rdev->mc.vram_location;
  194.         rdev->mc.vram_end = rdev->mc.vram_location + rdev->mc.mc_vram_size - 1;
  195.         rdev->mc.gtt_start = rdev->mc.gtt_location;
  196.         rdev->mc.gtt_end = rdev->mc.gtt_location + rdev->mc.gtt_size - 1;
  197.         DRM_INFO("radeon: VRAM %uM\n", (unsigned)(rdev->mc.mc_vram_size >> 20));
  198.         DRM_INFO("radeon: VRAM from 0x%08X to 0x%08X\n",
  199.                  (unsigned)rdev->mc.vram_location,
  200.                  (unsigned)(rdev->mc.vram_location + rdev->mc.mc_vram_size - 1));
  201.         DRM_INFO("radeon: GTT %uM\n", (unsigned)(rdev->mc.gtt_size >> 20));
  202.         DRM_INFO("radeon: GTT from 0x%08X to 0x%08X\n",
  203.                  (unsigned)rdev->mc.gtt_location,
  204.                  (unsigned)(rdev->mc.gtt_location + rdev->mc.gtt_size - 1));
  205.         return 0;
  206. }
  207.  
  208.  
  209. /*
  210.  * GPU helpers function.
  211.  */
  212. bool radeon_card_posted(struct radeon_device *rdev)
  213. {
  214.         uint32_t reg;
  215.  
  216.     ENTER();
  217.  
  218.         /* first check CRTCs */
  219.         if (ASIC_IS_AVIVO(rdev)) {
  220.                 reg = RREG32(AVIVO_D1CRTC_CONTROL) |
  221.                       RREG32(AVIVO_D2CRTC_CONTROL);
  222.                 if (reg & AVIVO_CRTC_EN) {
  223.                         return true;
  224.                 }
  225.         } else {
  226.                 reg = RREG32(RADEON_CRTC_GEN_CNTL) |
  227.                       RREG32(RADEON_CRTC2_GEN_CNTL);
  228.                 if (reg & RADEON_CRTC_EN) {
  229.                         return true;
  230.                 }
  231.         }
  232.  
  233.         /* then check MEM_SIZE, in case the crtcs are off */
  234.         if (rdev->family >= CHIP_R600)
  235.                 reg = RREG32(R600_CONFIG_MEMSIZE);
  236.         else
  237.                 reg = RREG32(RADEON_CONFIG_MEMSIZE);
  238.  
  239.         if (reg)
  240.                 return true;
  241.  
  242.         return false;
  243.  
  244. }
  245.  
  246. int radeon_dummy_page_init(struct radeon_device *rdev)
  247. {
  248.     rdev->dummy_page.page = AllocPage();
  249.         if (rdev->dummy_page.page == NULL)
  250.                 return -ENOMEM;
  251.     rdev->dummy_page.addr = MapIoMem(rdev->dummy_page.page, 4096, 5);
  252.         if (!rdev->dummy_page.addr) {
  253. //       __free_page(rdev->dummy_page.page);
  254.                 rdev->dummy_page.page = NULL;
  255.                 return -ENOMEM;
  256.         }
  257.         return 0;
  258. }
  259.  
  260. void radeon_dummy_page_fini(struct radeon_device *rdev)
  261. {
  262.         if (rdev->dummy_page.page == NULL)
  263.                 return;
  264.     KernelFree(rdev->dummy_page.addr);
  265.         rdev->dummy_page.page = NULL;
  266. }
  267.  
  268.  
  269. /*
  270.  * Registers accessors functions.
  271.  */
  272. uint32_t radeon_invalid_rreg(struct radeon_device *rdev, uint32_t reg)
  273. {
  274.     DRM_ERROR("Invalid callback to read register 0x%04X\n", reg);
  275.     BUG_ON(1);
  276.     return 0;
  277. }
  278.  
  279. void radeon_invalid_wreg(struct radeon_device *rdev, uint32_t reg, uint32_t v)
  280. {
  281.     DRM_ERROR("Invalid callback to write register 0x%04X with 0x%08X\n",
  282.           reg, v);
  283.     BUG_ON(1);
  284. }
  285.  
  286. void radeon_register_accessor_init(struct radeon_device *rdev)
  287. {
  288.     rdev->mc_rreg = &radeon_invalid_rreg;
  289.     rdev->mc_wreg = &radeon_invalid_wreg;
  290.     rdev->pll_rreg = &radeon_invalid_rreg;
  291.     rdev->pll_wreg = &radeon_invalid_wreg;
  292.     rdev->pciep_rreg = &radeon_invalid_rreg;
  293.     rdev->pciep_wreg = &radeon_invalid_wreg;
  294.  
  295.     /* Don't change order as we are overridding accessor. */
  296.     if (rdev->family < CHIP_RV515) {
  297.                 rdev->pcie_reg_mask = 0xff;
  298.         } else {
  299.                 rdev->pcie_reg_mask = 0x7ff;
  300.     }
  301.     /* FIXME: not sure here */
  302.     if (rdev->family <= CHIP_R580) {
  303.         rdev->pll_rreg = &r100_pll_rreg;
  304.         rdev->pll_wreg = &r100_pll_wreg;
  305.     }
  306.         if (rdev->family >= CHIP_R420) {
  307.                 rdev->mc_rreg = &r420_mc_rreg;
  308.                 rdev->mc_wreg = &r420_mc_wreg;
  309.         }
  310.     if (rdev->family >= CHIP_RV515) {
  311.         rdev->mc_rreg = &rv515_mc_rreg;
  312.         rdev->mc_wreg = &rv515_mc_wreg;
  313.     }
  314.     if (rdev->family == CHIP_RS400 || rdev->family == CHIP_RS480) {
  315.         rdev->mc_rreg = &rs400_mc_rreg;
  316.         rdev->mc_wreg = &rs400_mc_wreg;
  317.     }
  318.     if (rdev->family == CHIP_RS690 || rdev->family == CHIP_RS740) {
  319.         rdev->mc_rreg = &rs690_mc_rreg;
  320.         rdev->mc_wreg = &rs690_mc_wreg;
  321.     }
  322.     if (rdev->family == CHIP_RS600) {
  323.         rdev->mc_rreg = &rs600_mc_rreg;
  324.         rdev->mc_wreg = &rs600_mc_wreg;
  325.     }
  326.         if (rdev->family >= CHIP_R600) {
  327.                 rdev->pciep_rreg = &r600_pciep_rreg;
  328.                 rdev->pciep_wreg = &r600_pciep_wreg;
  329.         }
  330. }
  331.  
  332.  
  333. /*
  334.  * ASIC
  335.  */
  336. int radeon_asic_init(struct radeon_device *rdev)
  337. {
  338.     radeon_register_accessor_init(rdev);
  339.         switch (rdev->family) {
  340.         case CHIP_R100:
  341.         case CHIP_RV100:
  342.         case CHIP_RS100:
  343.         case CHIP_RV200:
  344.         case CHIP_RS200:
  345.         case CHIP_R200:
  346.         case CHIP_RV250:
  347.         case CHIP_RS300:
  348.         case CHIP_RV280:
  349.         rdev->asic = &r100_asic;
  350.                 break;
  351.         case CHIP_R300:
  352.         case CHIP_R350:
  353.         case CHIP_RV350:
  354.         case CHIP_RV380:
  355.         rdev->asic = &r300_asic;
  356.                 if (rdev->flags & RADEON_IS_PCIE) {
  357.                         rdev->asic->gart_tlb_flush = &rv370_pcie_gart_tlb_flush;
  358.                         rdev->asic->gart_set_page = &rv370_pcie_gart_set_page;
  359.                 }
  360.                 break;
  361.         case CHIP_R420:
  362.         case CHIP_R423:
  363.         case CHIP_RV410:
  364.         rdev->asic = &r420_asic;
  365.                 break;
  366.         case CHIP_RS400:
  367.         case CHIP_RS480:
  368.        rdev->asic = &rs400_asic;
  369.                 break;
  370.         case CHIP_RS600:
  371.         rdev->asic = &rs600_asic;
  372.                 break;
  373.         case CHIP_RS690:
  374.         case CHIP_RS740:
  375.         rdev->asic = &rs690_asic;
  376.                 break;
  377.         case CHIP_RV515:
  378.         rdev->asic = &rv515_asic;
  379.                 break;
  380.         case CHIP_R520:
  381.         case CHIP_RV530:
  382.         case CHIP_RV560:
  383.         case CHIP_RV570:
  384.         case CHIP_R580:
  385.         rdev->asic = &r520_asic;
  386.                 break;
  387.         case CHIP_R600:
  388.         case CHIP_RV610:
  389.         case CHIP_RV630:
  390.         case CHIP_RV620:
  391.         case CHIP_RV635:
  392.         case CHIP_RV670:
  393.         case CHIP_RS780:
  394.         case CHIP_RS880:
  395.                 rdev->asic = &r600_asic;
  396.                 break;
  397.         case CHIP_RV770:
  398.         case CHIP_RV730:
  399.         case CHIP_RV710:
  400.         case CHIP_RV740:
  401.                 rdev->asic = &rv770_asic;
  402.                 break;
  403.         default:
  404.                 /* FIXME: not supported yet */
  405.                 return -EINVAL;
  406.         }
  407.         return 0;
  408. }
  409.  
  410.  
  411. /*
  412.  * Wrapper around modesetting bits.
  413.  */
  414. int radeon_clocks_init(struct radeon_device *rdev)
  415. {
  416.         int r;
  417.  
  418.     ENTER();
  419.  
  420.     r = radeon_static_clocks_init(rdev->ddev);
  421.         if (r) {
  422.                 return r;
  423.         }
  424.         DRM_INFO("Clocks initialized !\n");
  425.         return 0;
  426. }
  427.  
  428. void radeon_clocks_fini(struct radeon_device *rdev)
  429. {
  430. }
  431.  
  432. /* ATOM accessor methods */
  433. static uint32_t cail_pll_read(struct card_info *info, uint32_t reg)
  434. {
  435.     struct radeon_device *rdev = info->dev->dev_private;
  436.     uint32_t r;
  437.  
  438.     r = rdev->pll_rreg(rdev, reg);
  439.     return r;
  440. }
  441.  
  442. static void cail_pll_write(struct card_info *info, uint32_t reg, uint32_t val)
  443. {
  444.     struct radeon_device *rdev = info->dev->dev_private;
  445.  
  446.     rdev->pll_wreg(rdev, reg, val);
  447. }
  448.  
  449. static uint32_t cail_mc_read(struct card_info *info, uint32_t reg)
  450. {
  451.     struct radeon_device *rdev = info->dev->dev_private;
  452.     uint32_t r;
  453.  
  454.     r = rdev->mc_rreg(rdev, reg);
  455.     return r;
  456. }
  457.  
  458. static void cail_mc_write(struct card_info *info, uint32_t reg, uint32_t val)
  459. {
  460.     struct radeon_device *rdev = info->dev->dev_private;
  461.  
  462.     rdev->mc_wreg(rdev, reg, val);
  463. }
  464.  
  465. static void cail_reg_write(struct card_info *info, uint32_t reg, uint32_t val)
  466. {
  467.     struct radeon_device *rdev = info->dev->dev_private;
  468.  
  469.     WREG32(reg*4, val);
  470. }
  471.  
  472. static uint32_t cail_reg_read(struct card_info *info, uint32_t reg)
  473. {
  474.     struct radeon_device *rdev = info->dev->dev_private;
  475.     uint32_t r;
  476.  
  477.     r = RREG32(reg*4);
  478.     return r;
  479. }
  480.  
  481. int radeon_atombios_init(struct radeon_device *rdev)
  482. {
  483.         struct card_info *atom_card_info =
  484.             kzalloc(sizeof(struct card_info), GFP_KERNEL);
  485.  
  486.         if (!atom_card_info)
  487.                 return -ENOMEM;
  488.  
  489.         rdev->mode_info.atom_card_info = atom_card_info;
  490.         atom_card_info->dev = rdev->ddev;
  491.         atom_card_info->reg_read = cail_reg_read;
  492.         atom_card_info->reg_write = cail_reg_write;
  493.         atom_card_info->mc_read = cail_mc_read;
  494.         atom_card_info->mc_write = cail_mc_write;
  495.         atom_card_info->pll_read = cail_pll_read;
  496.         atom_card_info->pll_write = cail_pll_write;
  497.  
  498.         rdev->mode_info.atom_context = atom_parse(atom_card_info, rdev->bios);
  499.     radeon_atom_initialize_bios_scratch_regs(rdev->ddev);
  500.     return 0;
  501. }
  502.  
  503. void radeon_atombios_fini(struct radeon_device *rdev)
  504. {
  505.         kfree(rdev->mode_info.atom_context);
  506.         kfree(rdev->mode_info.atom_card_info);
  507. }
  508.  
  509. int radeon_combios_init(struct radeon_device *rdev)
  510. {
  511.         radeon_combios_initialize_bios_scratch_regs(rdev->ddev);
  512.         return 0;
  513. }
  514.  
  515. void radeon_combios_fini(struct radeon_device *rdev)
  516. {
  517. }
  518.  
  519. /* if we get transitioned to only one device, tak VGA back */
  520. static unsigned int radeon_vga_set_decode(void *cookie, bool state)
  521. {
  522.         struct radeon_device *rdev = cookie;
  523.         radeon_vga_set_state(rdev, state);
  524.         if (state)
  525.                 return VGA_RSRC_LEGACY_IO | VGA_RSRC_LEGACY_MEM |
  526.                        VGA_RSRC_NORMAL_IO | VGA_RSRC_NORMAL_MEM;
  527.         else
  528.                 return VGA_RSRC_NORMAL_IO | VGA_RSRC_NORMAL_MEM;
  529. }
  530.  
  531. void radeon_agp_disable(struct radeon_device *rdev)
  532. {
  533.         rdev->flags &= ~RADEON_IS_AGP;
  534.         if (rdev->family >= CHIP_R600) {
  535.                 DRM_INFO("Forcing AGP to PCIE mode\n");
  536.                 rdev->flags |= RADEON_IS_PCIE;
  537.         } else if (rdev->family >= CHIP_RV515 ||
  538.                         rdev->family == CHIP_RV380 ||
  539.                         rdev->family == CHIP_RV410 ||
  540.                         rdev->family == CHIP_R423) {
  541.                 DRM_INFO("Forcing AGP to PCIE mode\n");
  542.                 rdev->flags |= RADEON_IS_PCIE;
  543.                 rdev->asic->gart_tlb_flush = &rv370_pcie_gart_tlb_flush;
  544.                 rdev->asic->gart_set_page = &rv370_pcie_gart_set_page;
  545.         } else {
  546.                 DRM_INFO("Forcing AGP to PCI mode\n");
  547.                 rdev->flags |= RADEON_IS_PCI;
  548.                 rdev->asic->gart_tlb_flush = &r100_pci_gart_tlb_flush;
  549.                 rdev->asic->gart_set_page = &r100_pci_gart_set_page;
  550.         }
  551. }
  552.  
  553. /*
  554.  * Radeon device.
  555.  */
  556. int radeon_device_init(struct radeon_device *rdev,
  557.                struct drm_device *ddev,
  558.                struct pci_dev *pdev,
  559.                uint32_t flags)
  560. {
  561.         int r;
  562.         int dma_bits;
  563.  
  564.     ENTER();
  565.  
  566.     DRM_INFO("radeon: Initializing kernel modesetting.\n");
  567.     rdev->shutdown = false;
  568.     rdev->ddev = ddev;
  569.     rdev->pdev = pdev;
  570.     rdev->flags = flags;
  571.     rdev->family = flags & RADEON_FAMILY_MASK;
  572.     rdev->is_atom_bios = false;
  573.     rdev->usec_timeout = RADEON_MAX_USEC_TIMEOUT;
  574.     rdev->mc.gtt_size = radeon_gart_size * 1024 * 1024;
  575.     rdev->gpu_lockup = false;
  576.         rdev->accel_working = false;
  577.     /* mutex initialization are all done here so we
  578.      * can recall function without having locking issues */
  579.  //   mutex_init(&rdev->cs_mutex);
  580.  //   mutex_init(&rdev->ib_pool.mutex);
  581.  //   mutex_init(&rdev->cp.mutex);
  582.  //   rwlock_init(&rdev->fence_drv.lock);
  583.  
  584.         /* Set asic functions */
  585.         r = radeon_asic_init(rdev);
  586.         if (r) {
  587.                 return r;
  588.         }
  589.  
  590.     if (radeon_agpmode == -1) {
  591.                 radeon_agp_disable(rdev);
  592.     }
  593.  
  594.         /* set DMA mask + need_dma32 flags.
  595.          * PCIE - can handle 40-bits.
  596.          * IGP - can handle 40-bits (in theory)
  597.          * AGP - generally dma32 is safest
  598.          * PCI - only dma32
  599.          */
  600.         rdev->need_dma32 = false;
  601.         if (rdev->flags & RADEON_IS_AGP)
  602.                 rdev->need_dma32 = true;
  603.         if (rdev->flags & RADEON_IS_PCI)
  604.                 rdev->need_dma32 = true;
  605.  
  606.         dma_bits = rdev->need_dma32 ? 32 : 40;
  607.         r = pci_set_dma_mask(rdev->pdev, DMA_BIT_MASK(dma_bits));
  608.     if (r) {
  609.         printk(KERN_WARNING "radeon: No suitable DMA available.\n");
  610.     }
  611.  
  612.     /* Registers mapping */
  613.     /* TODO: block userspace mapping of io register */
  614.     rdev->rmmio_base = pci_resource_start(rdev->pdev, 2);
  615.  
  616.     rdev->rmmio_size = pci_resource_len(rdev->pdev, 2);
  617.  
  618.     rdev->rmmio =  (void*)MapIoMem(rdev->rmmio_base, rdev->rmmio_size,
  619.                                    PG_SW+PG_NOCACHE);
  620.  
  621.     if (rdev->rmmio == NULL) {
  622.         return -ENOMEM;
  623.     }
  624.     DRM_INFO("register mmio base: 0x%08X\n", (uint32_t)rdev->rmmio_base);
  625.     DRM_INFO("register mmio size: %u\n", (unsigned)rdev->rmmio_size);
  626.  
  627.         /* if we have > 1 VGA cards, then disable the radeon VGA resources */
  628. //      r = vga_client_register(rdev->pdev, rdev, NULL, radeon_vga_set_decode);
  629. //      if (r) {
  630. //              return -EINVAL;
  631. //      }
  632.  
  633.         r = radeon_init(rdev);
  634.         if (r)
  635.             return r;
  636.  
  637.         if (rdev->flags & RADEON_IS_AGP && !rdev->accel_working) {
  638.                 /* Acceleration not working on AGP card try again
  639.                  * with fallback to PCI or PCIE GART
  640.                  */
  641.                 radeon_gpu_reset(rdev);
  642.                 radeon_fini(rdev);
  643.                 radeon_agp_disable(rdev);
  644.                 r = radeon_init(rdev);
  645.                 if (r)
  646.                 return r;
  647.         }
  648. //      if (radeon_testing) {
  649. //              radeon_test_moves(rdev);
  650. //    }
  651. //      if (radeon_benchmarking) {
  652. //              radeon_benchmark(rdev);
  653. //    }
  654.         return 0;
  655. }
  656.  
  657.  
  658. /*
  659.  * Driver load/unload
  660.  */
  661. int radeon_driver_load_kms(struct drm_device *dev, unsigned long flags)
  662. {
  663.     struct radeon_device *rdev;
  664.     int r;
  665.  
  666.     ENTER();
  667.  
  668.     rdev = kzalloc(sizeof(struct radeon_device), GFP_KERNEL);
  669.     if (rdev == NULL) {
  670.         return -ENOMEM;
  671.     };
  672.  
  673.     dev->dev_private = (void *)rdev;
  674.  
  675.     /* update BUS flag */
  676.     if (drm_device_is_agp(dev)) {
  677.         flags |= RADEON_IS_AGP;
  678.     } else if (drm_device_is_pcie(dev)) {
  679.         flags |= RADEON_IS_PCIE;
  680.     } else {
  681.         flags |= RADEON_IS_PCI;
  682.     }
  683.  
  684.     /* radeon_device_init should report only fatal error
  685.      * like memory allocation failure or iomapping failure,
  686.      * or memory manager initialization failure, it must
  687.      * properly initialize the GPU MC controller and permit
  688.      * VRAM allocation
  689.      */
  690.     r = radeon_device_init(rdev, dev, dev->pdev, flags);
  691.     if (r) {
  692.         DRM_ERROR("Fatal error while trying to initialize radeon.\n");
  693.         return r;
  694.     }
  695.     /* Again modeset_init should fail only on fatal error
  696.      * otherwise it should provide enough functionalities
  697.      * for shadowfb to run
  698.      */
  699.     if( radeon_modeset )
  700.     {
  701.         r = radeon_modeset_init(rdev);
  702.         if (r) {
  703.             return r;
  704.         }
  705.     };
  706.     return 0;
  707. }
  708.  
  709. mode_t usermode;
  710.  
  711.  
  712. int drm_get_dev(struct pci_dev *pdev, const struct pci_device_id *ent)
  713. {
  714.     static struct drm_device *dev;
  715.     int ret;
  716.  
  717.     ENTER();
  718.  
  719.     dev = kzalloc(sizeof(*dev), 0);
  720.     if (!dev)
  721.         return -ENOMEM;
  722.  
  723.  //   ret = pci_enable_device(pdev);
  724.  //   if (ret)
  725.  //       goto err_g1;
  726.  
  727.  //   pci_set_master(pdev);
  728.  
  729.  //   if ((ret = drm_fill_in_dev(dev, pdev, ent, driver))) {
  730.  //       printk(KERN_ERR "DRM: Fill_in_dev failed.\n");
  731.  //       goto err_g2;
  732.  //   }
  733.  
  734.     dev->pdev = pdev;
  735.     dev->pci_device = pdev->device;
  736.     dev->pci_vendor = pdev->vendor;
  737.  
  738.     ret = radeon_driver_load_kms(dev, ent->driver_data );
  739.     if (ret)
  740.         goto err_g4;
  741.  
  742.  //   list_add_tail(&dev->driver_item, &driver->device_list);
  743.  
  744.  //   DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n",
  745.  //        driver->name, driver->major, driver->minor, driver->patchlevel,
  746.  //        driver->date, pci_name(pdev), dev->primary->index);
  747.  
  748.     if( radeon_modeset )
  749.         init_display_kms(dev->dev_private, &usermode);
  750.     else
  751.         init_display(dev->dev_private, &usermode);
  752.  
  753.     LEAVE();
  754.  
  755.     return 0;
  756.  
  757. err_g4:
  758. //    drm_put_minor(&dev->primary);
  759. //err_g3:
  760. //    if (drm_core_check_feature(dev, DRIVER_MODESET))
  761. //        drm_put_minor(&dev->control);
  762. //err_g2:
  763. //    pci_disable_device(pdev);
  764. //err_g1:
  765.     free(dev);
  766.  
  767.     LEAVE();
  768.  
  769.     return ret;
  770. }
  771.  
  772. resource_size_t drm_get_resource_start(struct drm_device *dev, unsigned int resource)
  773. {
  774.     return pci_resource_start(dev->pdev, resource);
  775. }
  776.  
  777. resource_size_t drm_get_resource_len(struct drm_device *dev, unsigned int resource)
  778. {
  779.     return pci_resource_len(dev->pdev, resource);
  780. }
  781.  
  782.  
  783. uint32_t __div64_32(uint64_t *n, uint32_t base)
  784. {
  785.         uint64_t rem = *n;
  786.         uint64_t b = base;
  787.         uint64_t res, d = 1;
  788.         uint32_t high = rem >> 32;
  789.  
  790.         /* Reduce the thing a bit first */
  791.         res = 0;
  792.         if (high >= base) {
  793.                 high /= base;
  794.                 res = (uint64_t) high << 32;
  795.                 rem -= (uint64_t) (high*base) << 32;
  796.         }
  797.  
  798.         while ((int64_t)b > 0 && b < rem) {
  799.                 b = b+b;
  800.                 d = d+d;
  801.         }
  802.  
  803.         do {
  804.                 if (rem >= b) {
  805.                         rem -= b;
  806.                         res += d;
  807.                 }
  808.                 b >>= 1;
  809.                 d >>= 1;
  810.         } while (d);
  811.  
  812.         *n = res;
  813.         return rem;
  814. }
  815.  
  816.  
  817. static struct pci_device_id pciidlist[] = {
  818.     radeon_PCI_IDS
  819. };
  820.  
  821.  
  822. #define API_VERSION     0x01000100
  823.  
  824. #define SRV_GETVERSION  0
  825. #define SRV_ENUM_MODES  1
  826. #define SRV_SET_MODE    2
  827.  
  828. int _stdcall display_handler(ioctl_t *io)
  829. {
  830.     int    retval = -1;
  831.     u32_t *inp;
  832.     u32_t *outp;
  833.  
  834.     inp = io->input;
  835.     outp = io->output;
  836.  
  837.     switch(io->io_code)
  838.     {
  839.         case SRV_GETVERSION:
  840.             if(io->out_size==4)
  841.             {
  842.                 *outp  = API_VERSION;
  843.                 retval = 0;
  844.             }
  845.             break;
  846.  
  847.         case SRV_ENUM_MODES:
  848.             dbgprintf("SRV_ENUM_MODES inp %x inp_size %x out_size %x\n",
  849.                        inp, io->inp_size, io->out_size );
  850.  
  851.             if( radeon_modeset &&
  852.                 (outp != NULL) && (io->out_size == 4) &&
  853.                 (io->inp_size == *outp * sizeof(mode_t)) )
  854.             {
  855.                 retval = get_modes((mode_t*)inp, outp);
  856.             };
  857.             break;
  858.  
  859.         case SRV_SET_MODE:
  860.             dbgprintf("SRV_SET_MODE inp %x inp_size %x\n",
  861.                        inp, io->inp_size);
  862.  
  863.             if(  radeon_modeset   &&
  864.                 (inp != NULL) &&
  865.                 (io->inp_size == sizeof(mode_t)) )
  866.             {
  867.                 retval = set_user_mode((mode_t*)inp);
  868.             };
  869.             break;
  870.     };
  871.  
  872.     return retval;
  873. }
  874.  
  875. static char  log[256];
  876. static dev_t device;
  877.  
  878. u32_t drvEntry(int action, char *cmdline)
  879. {
  880.     struct pci_device_id  *ent;
  881.  
  882.     int     err;
  883.     u32_t   retval = 0;
  884.  
  885.     if(action != 1)
  886.         return 0;
  887.  
  888.     if( GetService("DISPLAY") != 0 )
  889.         return 0;
  890.  
  891.     if( cmdline && *cmdline )
  892.         parse_cmdline(cmdline, &usermode, log, &radeon_modeset);
  893.  
  894.     if(!dbg_open(log))
  895.     {
  896.         strcpy(log, "/rd/1/drivers/atikms.log");
  897.  
  898.         if(!dbg_open(log))
  899.         {
  900.             printf("Can't open %s\nExit\n", log);
  901.             return 0;
  902.         };
  903.     }
  904.     dbgprintf("Radeon RC06 cmdline %s\n", cmdline);
  905.  
  906.     enum_pci_devices();
  907.  
  908.     ent = find_pci_device(&device, pciidlist);
  909.  
  910.     if( unlikely(ent == NULL) )
  911.     {
  912.         dbgprintf("device not found\n");
  913.         return 0;
  914.     };
  915.  
  916.     dbgprintf("device %x:%x\n", device.pci_dev.vendor,
  917.                                 device.pci_dev.device);
  918.  
  919.     err = drm_get_dev(&device.pci_dev, ent);
  920.  
  921.     err = RegService("DISPLAY", display_handler);
  922.  
  923.     if( err != 0)
  924.         dbgprintf("Set DISPLAY handler\n");
  925.  
  926.     return err;
  927. };
  928.