1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30#include <linux/firmware.h>
31#include <linux/ihex.h>
32#include <linux/platform_device.h>
33#include <linux/module.h>
34
35#include <drm/drmP.h>
36#include <drm/mga_drm.h>
37#include "mga_drv.h"
38
39#define FIRMWARE_G200 "matrox/g200_warp.fw"
40#define FIRMWARE_G400 "matrox/g400_warp.fw"
41
42MODULE_FIRMWARE(FIRMWARE_G200);
43MODULE_FIRMWARE(FIRMWARE_G400);
44
45#define MGA_WARP_CODE_ALIGN 256
46
47#define WARP_UCODE_SIZE(size) ALIGN(size, MGA_WARP_CODE_ALIGN)
48
49int mga_warp_install_microcode(drm_mga_private_t *dev_priv)
50{
51 unsigned char *vcbase = dev_priv->warp->handle;
52 unsigned long pcbase = dev_priv->warp->offset;
53 const char *firmware_name;
54 struct platform_device *pdev;
55 const struct firmware *fw = NULL;
56 const struct ihex_binrec *rec;
57 unsigned int size;
58 int n_pipes, where;
59 int rc = 0;
60
61 switch (dev_priv->chipset) {
62 case MGA_CARD_TYPE_G400:
63 case MGA_CARD_TYPE_G550:
64 firmware_name = FIRMWARE_G400;
65 n_pipes = MGA_MAX_G400_PIPES;
66 break;
67 case MGA_CARD_TYPE_G200:
68 firmware_name = FIRMWARE_G200;
69 n_pipes = MGA_MAX_G200_PIPES;
70 break;
71 default:
72 return -EINVAL;
73 }
74
75 pdev = platform_device_register_simple("mga_warp", 0, NULL, 0);
76 if (IS_ERR(pdev)) {
77 DRM_ERROR("mga: Failed to register microcode\n");
78 return PTR_ERR(pdev);
79 }
80 rc = request_ihex_firmware(&fw, firmware_name, &pdev->dev);
81 platform_device_unregister(pdev);
82 if (rc) {
83 DRM_ERROR("mga: Failed to load microcode \"%s\"\n",
84 firmware_name);
85 return rc;
86 }
87
88 size = 0;
89 where = 0;
90 for (rec = (const struct ihex_binrec *)fw->data;
91 rec;
92 rec = ihex_next_binrec(rec)) {
93 size += WARP_UCODE_SIZE(be16_to_cpu(rec->len));
94 where++;
95 }
96
97 if (where != n_pipes) {
98 DRM_ERROR("mga: Invalid microcode \"%s\"\n", firmware_name);
99 rc = -EINVAL;
100 goto out;
101 }
102 size = PAGE_ALIGN(size);
103 DRM_DEBUG("MGA ucode size = %d bytes\n", size);
104 if (size > dev_priv->warp->size) {
105 DRM_ERROR("microcode too large! (%u > %lu)\n",
106 size, dev_priv->warp->size);
107 rc = -ENOMEM;
108 goto out;
109 }
110
111 memset(dev_priv->warp_pipe_phys, 0, sizeof(dev_priv->warp_pipe_phys));
112
113 where = 0;
114 for (rec = (const struct ihex_binrec *)fw->data;
115 rec;
116 rec = ihex_next_binrec(rec)) {
117 unsigned int src_size, dst_size;
118
119 DRM_DEBUG(" pcbase = 0x%08lx vcbase = %p\n", pcbase, vcbase);
120 dev_priv->warp_pipe_phys[where] = pcbase;
121 src_size = be16_to_cpu(rec->len);
122 dst_size = WARP_UCODE_SIZE(src_size);
123 memcpy(vcbase, rec->data, src_size);
124 pcbase += dst_size;
125 vcbase += dst_size;
126 where++;
127 }
128
129out:
130 release_firmware(fw);
131 return rc;
132}
133
134#define WMISC_EXPECTED (MGA_WUCODECACHE_ENABLE | MGA_WMASTER_ENABLE)
135
136int mga_warp_init(drm_mga_private_t *dev_priv)
137{
138 u32 wmisc;
139
140
141
142 switch (dev_priv->chipset) {
143 case MGA_CARD_TYPE_G400:
144 case MGA_CARD_TYPE_G550:
145 MGA_WRITE(MGA_WIADDR2, MGA_WMODE_SUSPEND);
146 MGA_WRITE(MGA_WGETMSB, 0x00000E00);
147 MGA_WRITE(MGA_WVRTXSZ, 0x00001807);
148 MGA_WRITE(MGA_WACCEPTSEQ, 0x18000000);
149 break;
150 case MGA_CARD_TYPE_G200:
151 MGA_WRITE(MGA_WIADDR, MGA_WMODE_SUSPEND);
152 MGA_WRITE(MGA_WGETMSB, 0x1606);
153 MGA_WRITE(MGA_WVRTXSZ, 7);
154 break;
155 default:
156 return -EINVAL;
157 }
158
159 MGA_WRITE(MGA_WMISC, (MGA_WUCODECACHE_ENABLE |
160 MGA_WMASTER_ENABLE | MGA_WCACHEFLUSH_ENABLE));
161 wmisc = MGA_READ(MGA_WMISC);
162 if (wmisc != WMISC_EXPECTED) {
163 DRM_ERROR("WARP engine config failed! 0x%x != 0x%x\n",
164 wmisc, WMISC_EXPECTED);
165 return -EINVAL;
166 }
167
168 return 0;
169}
170
