2 * PMC551 PCI Mezzanine Ram Device
5 * Mark Ferrell <mferrell@mvista.com>
6 * Copyright 1999,2000 Nortel Networks
9 * As part of this driver was derived from the slram.c driver it
10 * falls under the same license, which is GNU General Public
14 * This driver is intended to support the PMC551 PCI Ram device
15 * from Ramix Inc. The PMC551 is a PMC Mezzanine module for
16 * cPCI embedded systems. The device contains a single SROM
17 * that initially programs the V370PDC chipset onboard the
18 * device, and various banks of DRAM/SDRAM onboard. This driver
19 * implements this PCI Ram device as an MTD (Memory Technology
20 * Device) so that it can be used to hold a file system, or for
21 * added swap space in embedded systems. Since the memory on
22 * this board isn't as fast as main memory we do not try to hook
23 * it into main memory as that would simply reduce performance
24 * on the system. Using it as a block device allows us to use
25 * it as high speed swap or for a high speed disk device of some
26 * sort. Which becomes very useful on diskless systems in the
27 * embedded market I might add.
30 * Due to what I assume is more buggy SROM, the 64M PMC551 I
31 * have available claims that all 4 of its DRAM banks have 64MiB
32 * of ram configured (making a grand total of 256MiB onboard).
33 * This is slightly annoying since the BAR0 size reflects the
34 * aperture size, not the dram size, and the V370PDC supplies no
35 * other method for memory size discovery. This problem is
36 * mostly only relevant when compiled as a module, as the
37 * unloading of the module with an aperture size smaller than
38 * the ram will cause the driver to detect the onboard memory
39 * size to be equal to the aperture size when the module is
40 * reloaded. Soooo, to help, the module supports an msize
41 * option to allow the specification of the onboard memory, and
42 * an asize option, to allow the specification of the aperture
43 * size. The aperture must be equal to or less then the memory
44 * size, the driver will correct this if you screw it up. This
45 * problem is not relevant for compiled in drivers as compiled
46 * in drivers only init once.
49 * Saeed Karamooz <saeed@ramix.com> of Ramix INC. for the
50 * initial example code of how to initialize this device and for
51 * help with questions I had concerning operation of the device.
53 * Most of the MTD code for this driver was originally written
54 * for the slram.o module in the MTD drivers package which
55 * allows the mapping of system memory into an MTD device.
56 * Since the PMC551 memory module is accessed in the same
57 * fashion as system memory, the slram.c code became a very nice
58 * fit to the needs of this driver. All we added was PCI
59 * detection/initialization to the driver and automatically figure
60 * out the size via the PCI detection.o, later changes by Corey
61 * Minyard set up the card to utilize a 1M sliding apature.
63 * Corey Minyard <minyard@nortelnetworks.com>
64 * * Modified driver to utilize a sliding aperture instead of
65 * mapping all memory into kernel space which turned out to
67 * * Located a bug in the SROM's initialization sequence that
68 * made the memory unusable, added a fix to code to touch up
72 * * MUST fix the init function to not spin on a register
73 * waiting for it to set .. this does not safely handle busted
74 * devices that never reset the register correctly which will
75 * cause the system to hang w/ a reboot being the only chance at
76 * recover. [sort of fixed, could be better]
77 * * Add I2C handling of the SROM so we can read the SROM's information
78 * about the aperture size. This should always accurately reflect the
79 * onboard memory size.
80 * * Comb the init routine. It's still a bit cludgy on a few things.
83 #include <linux/kernel.h>
84 #include <linux/module.h>
85 #include <asm/uaccess.h>
86 #include <linux/types.h>
87 #include <linux/init.h>
88 #include <linux/ptrace.h>
89 #include <linux/slab.h>
90 #include <linux/string.h>
91 #include <linux/timer.h>
92 #include <linux/major.h>
94 #include <linux/ioctl.h>
96 #include <asm/system.h>
97 #include <linux/pci.h>
99 #include <linux/mtd/mtd.h>
100 #include <linux/mtd/pmc551.h>
102 static struct mtd_info
*pmc551list
;
104 static int pmc551_erase(struct mtd_info
*mtd
, struct erase_info
*instr
)
106 struct mypriv
*priv
= mtd
->priv
;
107 u32 soff_hi
, soff_lo
; /* start address offset hi/lo */
108 u32 eoff_hi
, eoff_lo
; /* end address offset hi/lo */
113 #ifdef CONFIG_MTD_PMC551_DEBUG
114 printk(KERN_DEBUG
"pmc551_erase(pos:%ld, len:%ld)\n", (long)instr
->addr
,
118 end
= instr
->addr
+ instr
->len
- 1;
120 /* Is it past the end? */
121 if (end
> mtd
->size
) {
122 #ifdef CONFIG_MTD_PMC551_DEBUG
123 printk(KERN_DEBUG
"pmc551_erase() out of bounds (%ld > %ld)\n",
124 (long)end
, (long)mtd
->size
);
129 eoff_hi
= end
& ~(priv
->asize
- 1);
130 soff_hi
= instr
->addr
& ~(priv
->asize
- 1);
131 eoff_lo
= end
& (priv
->asize
- 1);
132 soff_lo
= instr
->addr
& (priv
->asize
- 1);
134 pmc551_point(mtd
, instr
->addr
, instr
->len
, &retlen
,
135 (void **)&ptr
, NULL
);
137 if (soff_hi
== eoff_hi
|| mtd
->size
== priv
->asize
) {
138 /* The whole thing fits within one access, so just one shot
140 memset(ptr
, 0xff, instr
->len
);
142 /* We have to do multiple writes to get all the data
144 while (soff_hi
!= eoff_hi
) {
145 #ifdef CONFIG_MTD_PMC551_DEBUG
146 printk(KERN_DEBUG
"pmc551_erase() soff_hi: %ld, "
147 "eoff_hi: %ld\n", (long)soff_hi
, (long)eoff_hi
);
149 memset(ptr
, 0xff, priv
->asize
);
150 if (soff_hi
+ priv
->asize
>= mtd
->size
) {
153 soff_hi
+= priv
->asize
;
154 pmc551_point(mtd
, (priv
->base_map0
| soff_hi
),
155 priv
->asize
, &retlen
,
156 (void **)&ptr
, NULL
);
158 memset(ptr
, 0xff, eoff_lo
);
162 instr
->state
= MTD_ERASE_DONE
;
163 #ifdef CONFIG_MTD_PMC551_DEBUG
164 printk(KERN_DEBUG
"pmc551_erase() done\n");
167 mtd_erase_callback(instr
);
171 static int pmc551_point(struct mtd_info
*mtd
, loff_t from
, size_t len
,
172 size_t *retlen
, void **virt
, resource_size_t
*phys
)
174 struct mypriv
*priv
= mtd
->priv
;
178 #ifdef CONFIG_MTD_PMC551_DEBUG
179 printk(KERN_DEBUG
"pmc551_point(%ld, %ld)\n", (long)from
, (long)len
);
182 if (from
+ len
> mtd
->size
) {
183 #ifdef CONFIG_MTD_PMC551_DEBUG
184 printk(KERN_DEBUG
"pmc551_point() out of bounds (%ld > %ld)\n",
185 (long)from
+ len
, (long)mtd
->size
);
190 /* can we return a physical address with this driver? */
194 soff_hi
= from
& ~(priv
->asize
- 1);
195 soff_lo
= from
& (priv
->asize
- 1);
197 /* Cheap hack optimization */
198 if (priv
->curr_map0
!= from
) {
199 pci_write_config_dword(priv
->dev
, PMC551_PCI_MEM_MAP0
,
200 (priv
->base_map0
| soff_hi
));
201 priv
->curr_map0
= soff_hi
;
204 *virt
= priv
->start
+ soff_lo
;
209 static int pmc551_unpoint(struct mtd_info
*mtd
, loff_t from
, size_t len
)
211 #ifdef CONFIG_MTD_PMC551_DEBUG
212 printk(KERN_DEBUG
"pmc551_unpoint()\n");
217 static int pmc551_read(struct mtd_info
*mtd
, loff_t from
, size_t len
,
218 size_t * retlen
, u_char
* buf
)
220 struct mypriv
*priv
= mtd
->priv
;
221 u32 soff_hi
, soff_lo
; /* start address offset hi/lo */
222 u32 eoff_hi
, eoff_lo
; /* end address offset hi/lo */
225 u_char
*copyto
= buf
;
227 #ifdef CONFIG_MTD_PMC551_DEBUG
228 printk(KERN_DEBUG
"pmc551_read(pos:%ld, len:%ld) asize: %ld\n",
229 (long)from
, (long)len
, (long)priv
->asize
);
232 end
= from
+ len
- 1;
234 /* Is it past the end? */
235 if (end
> mtd
->size
) {
236 #ifdef CONFIG_MTD_PMC551_DEBUG
237 printk(KERN_DEBUG
"pmc551_read() out of bounds (%ld > %ld)\n",
238 (long)end
, (long)mtd
->size
);
243 soff_hi
= from
& ~(priv
->asize
- 1);
244 eoff_hi
= end
& ~(priv
->asize
- 1);
245 soff_lo
= from
& (priv
->asize
- 1);
246 eoff_lo
= end
& (priv
->asize
- 1);
248 pmc551_point(mtd
, from
, len
, retlen
, (void **)&ptr
, NULL
);
250 if (soff_hi
== eoff_hi
) {
251 /* The whole thing fits within one access, so just one shot
253 memcpy(copyto
, ptr
, len
);
256 /* We have to do multiple writes to get all the data
258 while (soff_hi
!= eoff_hi
) {
259 #ifdef CONFIG_MTD_PMC551_DEBUG
260 printk(KERN_DEBUG
"pmc551_read() soff_hi: %ld, "
261 "eoff_hi: %ld\n", (long)soff_hi
, (long)eoff_hi
);
263 memcpy(copyto
, ptr
, priv
->asize
);
264 copyto
+= priv
->asize
;
265 if (soff_hi
+ priv
->asize
>= mtd
->size
) {
268 soff_hi
+= priv
->asize
;
269 pmc551_point(mtd
, soff_hi
, priv
->asize
, retlen
,
270 (void **)&ptr
, NULL
);
272 memcpy(copyto
, ptr
, eoff_lo
);
277 #ifdef CONFIG_MTD_PMC551_DEBUG
278 printk(KERN_DEBUG
"pmc551_read() done\n");
280 *retlen
= copyto
- buf
;
284 static int pmc551_write(struct mtd_info
*mtd
, loff_t to
, size_t len
,
285 size_t * retlen
, const u_char
* buf
)
287 struct mypriv
*priv
= mtd
->priv
;
288 u32 soff_hi
, soff_lo
; /* start address offset hi/lo */
289 u32 eoff_hi
, eoff_lo
; /* end address offset hi/lo */
292 const u_char
*copyfrom
= buf
;
294 #ifdef CONFIG_MTD_PMC551_DEBUG
295 printk(KERN_DEBUG
"pmc551_write(pos:%ld, len:%ld) asize:%ld\n",
296 (long)to
, (long)len
, (long)priv
->asize
);
300 /* Is it past the end? or did the u32 wrap? */
301 if (end
> mtd
->size
) {
302 #ifdef CONFIG_MTD_PMC551_DEBUG
303 printk(KERN_DEBUG
"pmc551_write() out of bounds (end: %ld, "
304 "size: %ld, to: %ld)\n", (long)end
, (long)mtd
->size
,
310 soff_hi
= to
& ~(priv
->asize
- 1);
311 eoff_hi
= end
& ~(priv
->asize
- 1);
312 soff_lo
= to
& (priv
->asize
- 1);
313 eoff_lo
= end
& (priv
->asize
- 1);
315 pmc551_point(mtd
, to
, len
, retlen
, (void **)&ptr
, NULL
);
317 if (soff_hi
== eoff_hi
) {
318 /* The whole thing fits within one access, so just one shot
320 memcpy(ptr
, copyfrom
, len
);
323 /* We have to do multiple writes to get all the data
325 while (soff_hi
!= eoff_hi
) {
326 #ifdef CONFIG_MTD_PMC551_DEBUG
327 printk(KERN_DEBUG
"pmc551_write() soff_hi: %ld, "
328 "eoff_hi: %ld\n", (long)soff_hi
, (long)eoff_hi
);
330 memcpy(ptr
, copyfrom
, priv
->asize
);
331 copyfrom
+= priv
->asize
;
332 if (soff_hi
>= mtd
->size
) {
335 soff_hi
+= priv
->asize
;
336 pmc551_point(mtd
, soff_hi
, priv
->asize
, retlen
,
337 (void **)&ptr
, NULL
);
339 memcpy(ptr
, copyfrom
, eoff_lo
);
344 #ifdef CONFIG_MTD_PMC551_DEBUG
345 printk(KERN_DEBUG
"pmc551_write() done\n");
347 *retlen
= copyfrom
- buf
;
352 * Fixup routines for the V370PDC
353 * PCI device ID 0x020011b0
355 * This function basically kick starts the DRAM oboard the card and gets it
356 * ready to be used. Before this is done the device reads VERY erratic, so
357 * much that it can crash the Linux 2.2.x series kernels when a user cat's
358 * /proc/pci .. though that is mainly a kernel bug in handling the PCI DEVSEL
359 * register. FIXME: stop spinning on registers .. must implement a timeout
361 * returns the size of the memory region found.
363 static int fixup_pmc551(struct pci_dev
*dev
)
365 #ifdef CONFIG_MTD_PMC551_BUGFIX
368 u32 size
, dcmd
, cfg
, dtmp
;
378 * Attempt to reset the card
379 * FIXME: Stop Spinning registers
382 /* unlock registers */
383 pci_write_config_byte(dev
, PMC551_SYS_CTRL_REG
, 0xA5);
384 /* read in old data */
385 pci_read_config_byte(dev
, PMC551_SYS_CTRL_REG
, &bcmd
);
386 /* bang the reset line up and down for a few */
387 for (i
= 0; i
< 10; i
++) {
390 while (counter
++ < 100) {
391 pci_write_config_byte(dev
, PMC551_SYS_CTRL_REG
, bcmd
);
395 while (counter
++ < 100) {
396 pci_write_config_byte(dev
, PMC551_SYS_CTRL_REG
, bcmd
);
399 bcmd
|= (0x40 | 0x20);
400 pci_write_config_byte(dev
, PMC551_SYS_CTRL_REG
, bcmd
);
403 * Take care and turn off the memory on the device while we
404 * tweak the configurations
406 pci_read_config_word(dev
, PCI_COMMAND
, &cmd
);
407 tmp
= cmd
& ~(PCI_COMMAND_IO
| PCI_COMMAND_MEMORY
);
408 pci_write_config_word(dev
, PCI_COMMAND
, tmp
);
411 * Disable existing aperture before probing memory size
413 pci_read_config_dword(dev
, PMC551_PCI_MEM_MAP0
, &dcmd
);
414 dtmp
= (dcmd
| PMC551_PCI_MEM_MAP_ENABLE
| PMC551_PCI_MEM_MAP_REG_EN
);
415 pci_write_config_dword(dev
, PMC551_PCI_MEM_MAP0
, dtmp
);
417 * Grab old BAR0 config so that we can figure out memory size
418 * This is another bit of kludge going on. The reason for the
419 * redundancy is I am hoping to retain the original configuration
420 * previously assigned to the card by the BIOS or some previous
421 * fixup routine in the kernel. So we read the old config into cfg,
422 * then write all 1's to the memory space, read back the result into
423 * "size", and then write back all the old config.
425 pci_read_config_dword(dev
, PCI_BASE_ADDRESS_0
, &cfg
);
426 #ifndef CONFIG_MTD_PMC551_BUGFIX
427 pci_write_config_dword(dev
, PCI_BASE_ADDRESS_0
, ~0);
428 pci_read_config_dword(dev
, PCI_BASE_ADDRESS_0
, &size
);
429 size
= (size
& PCI_BASE_ADDRESS_MEM_MASK
);
431 pci_write_config_dword(dev
, PCI_BASE_ADDRESS_0
, cfg
);
434 * Get the size of the memory by reading all the DRAM size values
435 * and adding them up.
437 * KLUDGE ALERT: the boards we are using have invalid column and
438 * row mux values. We fix them here, but this will break other
439 * memory configurations.
441 pci_read_config_dword(dev
, PMC551_DRAM_BLK0
, &dram_data
);
442 size
= PMC551_DRAM_BLK_GET_SIZE(dram_data
);
443 dram_data
= PMC551_DRAM_BLK_SET_COL_MUX(dram_data
, 0x5);
444 dram_data
= PMC551_DRAM_BLK_SET_ROW_MUX(dram_data
, 0x9);
445 pci_write_config_dword(dev
, PMC551_DRAM_BLK0
, dram_data
);
447 pci_read_config_dword(dev
, PMC551_DRAM_BLK1
, &dram_data
);
448 size
+= PMC551_DRAM_BLK_GET_SIZE(dram_data
);
449 dram_data
= PMC551_DRAM_BLK_SET_COL_MUX(dram_data
, 0x5);
450 dram_data
= PMC551_DRAM_BLK_SET_ROW_MUX(dram_data
, 0x9);
451 pci_write_config_dword(dev
, PMC551_DRAM_BLK1
, dram_data
);
453 pci_read_config_dword(dev
, PMC551_DRAM_BLK2
, &dram_data
);
454 size
+= PMC551_DRAM_BLK_GET_SIZE(dram_data
);
455 dram_data
= PMC551_DRAM_BLK_SET_COL_MUX(dram_data
, 0x5);
456 dram_data
= PMC551_DRAM_BLK_SET_ROW_MUX(dram_data
, 0x9);
457 pci_write_config_dword(dev
, PMC551_DRAM_BLK2
, dram_data
);
459 pci_read_config_dword(dev
, PMC551_DRAM_BLK3
, &dram_data
);
460 size
+= PMC551_DRAM_BLK_GET_SIZE(dram_data
);
461 dram_data
= PMC551_DRAM_BLK_SET_COL_MUX(dram_data
, 0x5);
462 dram_data
= PMC551_DRAM_BLK_SET_ROW_MUX(dram_data
, 0x9);
463 pci_write_config_dword(dev
, PMC551_DRAM_BLK3
, dram_data
);
466 * Oops .. something went wrong
468 if ((size
&= PCI_BASE_ADDRESS_MEM_MASK
) == 0) {
471 #endif /* CONFIG_MTD_PMC551_BUGFIX */
473 if ((cfg
& PCI_BASE_ADDRESS_SPACE
) != PCI_BASE_ADDRESS_SPACE_MEMORY
) {
480 pci_write_config_word(dev
, PMC551_SDRAM_MA
, 0x0400);
481 pci_write_config_word(dev
, PMC551_SDRAM_CMD
, 0x00bf);
484 * Wait until command has gone through
485 * FIXME: register spinning issue
488 pci_read_config_word(dev
, PMC551_SDRAM_CMD
, &cmd
);
491 } while ((PCI_COMMAND_IO
) & cmd
);
494 * Turn on auto refresh
495 * The loop is taken directly from Ramix's example code. I assume that
496 * this must be held high for some duration of time, but I can find no
497 * documentation refrencing the reasons why.
499 for (i
= 1; i
<= 8; i
++) {
500 pci_write_config_word(dev
, PMC551_SDRAM_CMD
, 0x0df);
503 * Make certain command has gone through
504 * FIXME: register spinning issue
508 pci_read_config_word(dev
, PMC551_SDRAM_CMD
, &cmd
);
511 } while ((PCI_COMMAND_IO
) & cmd
);
514 pci_write_config_word(dev
, PMC551_SDRAM_MA
, 0x0020);
515 pci_write_config_word(dev
, PMC551_SDRAM_CMD
, 0x0ff);
518 * Wait until command completes
519 * FIXME: register spinning issue
523 pci_read_config_word(dev
, PMC551_SDRAM_CMD
, &cmd
);
526 } while ((PCI_COMMAND_IO
) & cmd
);
528 pci_read_config_dword(dev
, PMC551_DRAM_CFG
, &dcmd
);
530 pci_write_config_dword(dev
, PMC551_DRAM_CFG
, dcmd
);
533 * Check to make certain fast back-to-back, if not
536 pci_read_config_word(dev
, PCI_STATUS
, &cmd
);
537 if ((cmd
& PCI_COMMAND_FAST_BACK
) == 0) {
538 cmd
|= PCI_COMMAND_FAST_BACK
;
539 pci_write_config_word(dev
, PCI_STATUS
, cmd
);
543 * Check to make certain the DEVSEL is set correctly, this device
544 * has a tendency to assert DEVSEL and TRDY when a write is performed
545 * to the memory when memory is read-only
547 if ((cmd
& PCI_STATUS_DEVSEL_MASK
) != 0x0) {
548 cmd
&= ~PCI_STATUS_DEVSEL_MASK
;
549 pci_write_config_word(dev
, PCI_STATUS
, cmd
);
552 * Set to be prefetchable and put everything back based on old cfg.
553 * it's possible that the reset of the V370PDC nuked the original
557 cfg |= PCI_BASE_ADDRESS_MEM_PREFETCH;
558 pci_write_config_dword( dev, PCI_BASE_ADDRESS_0, cfg );
562 * Turn PCI memory and I/O bus access back on
564 pci_write_config_word(dev
, PCI_COMMAND
,
565 PCI_COMMAND_MEMORY
| PCI_COMMAND_IO
);
566 #ifdef CONFIG_MTD_PMC551_DEBUG
570 printk(KERN_DEBUG
"pmc551: %d%sB (0x%x) of %sprefetchable memory at "
571 "0x%llx\n", (size
< 1024) ? size
: (size
< 1048576) ?
572 size
>> 10 : size
>> 20,
573 (size
< 1024) ? "" : (size
< 1048576) ? "Ki" : "Mi", size
,
574 ((dcmd
& (0x1 << 3)) == 0) ? "non-" : "",
575 (unsigned long long)pci_resource_start(dev
, 0));
578 * Check to see the state of the memory
580 pci_read_config_dword(dev
, PMC551_DRAM_BLK0
, &dcmd
);
581 printk(KERN_DEBUG
"pmc551: DRAM_BLK0 Flags: %s,%s\n"
582 "pmc551: DRAM_BLK0 Size: %d at %d\n"
583 "pmc551: DRAM_BLK0 Row MUX: %d, Col MUX: %d\n",
584 (((0x1 << 1) & dcmd
) == 0) ? "RW" : "RO",
585 (((0x1 << 0) & dcmd
) == 0) ? "Off" : "On",
586 PMC551_DRAM_BLK_GET_SIZE(dcmd
),
587 ((dcmd
>> 20) & 0x7FF), ((dcmd
>> 13) & 0x7),
588 ((dcmd
>> 9) & 0xF));
590 pci_read_config_dword(dev
, PMC551_DRAM_BLK1
, &dcmd
);
591 printk(KERN_DEBUG
"pmc551: DRAM_BLK1 Flags: %s,%s\n"
592 "pmc551: DRAM_BLK1 Size: %d at %d\n"
593 "pmc551: DRAM_BLK1 Row MUX: %d, Col MUX: %d\n",
594 (((0x1 << 1) & dcmd
) == 0) ? "RW" : "RO",
595 (((0x1 << 0) & dcmd
) == 0) ? "Off" : "On",
596 PMC551_DRAM_BLK_GET_SIZE(dcmd
),
597 ((dcmd
>> 20) & 0x7FF), ((dcmd
>> 13) & 0x7),
598 ((dcmd
>> 9) & 0xF));
600 pci_read_config_dword(dev
, PMC551_DRAM_BLK2
, &dcmd
);
601 printk(KERN_DEBUG
"pmc551: DRAM_BLK2 Flags: %s,%s\n"
602 "pmc551: DRAM_BLK2 Size: %d at %d\n"
603 "pmc551: DRAM_BLK2 Row MUX: %d, Col MUX: %d\n",
604 (((0x1 << 1) & dcmd
) == 0) ? "RW" : "RO",
605 (((0x1 << 0) & dcmd
) == 0) ? "Off" : "On",
606 PMC551_DRAM_BLK_GET_SIZE(dcmd
),
607 ((dcmd
>> 20) & 0x7FF), ((dcmd
>> 13) & 0x7),
608 ((dcmd
>> 9) & 0xF));
610 pci_read_config_dword(dev
, PMC551_DRAM_BLK3
, &dcmd
);
611 printk(KERN_DEBUG
"pmc551: DRAM_BLK3 Flags: %s,%s\n"
612 "pmc551: DRAM_BLK3 Size: %d at %d\n"
613 "pmc551: DRAM_BLK3 Row MUX: %d, Col MUX: %d\n",
614 (((0x1 << 1) & dcmd
) == 0) ? "RW" : "RO",
615 (((0x1 << 0) & dcmd
) == 0) ? "Off" : "On",
616 PMC551_DRAM_BLK_GET_SIZE(dcmd
),
617 ((dcmd
>> 20) & 0x7FF), ((dcmd
>> 13) & 0x7),
618 ((dcmd
>> 9) & 0xF));
620 pci_read_config_word(dev
, PCI_COMMAND
, &cmd
);
621 printk(KERN_DEBUG
"pmc551: Memory Access %s\n",
622 (((0x1 << 1) & cmd
) == 0) ? "off" : "on");
623 printk(KERN_DEBUG
"pmc551: I/O Access %s\n",
624 (((0x1 << 0) & cmd
) == 0) ? "off" : "on");
626 pci_read_config_word(dev
, PCI_STATUS
, &cmd
);
627 printk(KERN_DEBUG
"pmc551: Devsel %s\n",
628 ((PCI_STATUS_DEVSEL_MASK
& cmd
) == 0x000) ? "Fast" :
629 ((PCI_STATUS_DEVSEL_MASK
& cmd
) == 0x200) ? "Medium" :
630 ((PCI_STATUS_DEVSEL_MASK
& cmd
) == 0x400) ? "Slow" : "Invalid");
632 printk(KERN_DEBUG
"pmc551: %sFast Back-to-Back\n",
633 ((PCI_COMMAND_FAST_BACK
& cmd
) == 0) ? "Not " : "");
635 pci_read_config_byte(dev
, PMC551_SYS_CTRL_REG
, &bcmd
);
636 printk(KERN_DEBUG
"pmc551: EEPROM is under %s control\n"
637 "pmc551: System Control Register is %slocked to PCI access\n"
638 "pmc551: System Control Register is %slocked to EEPROM access\n",
639 (bcmd
& 0x1) ? "software" : "hardware",
640 (bcmd
& 0x20) ? "" : "un", (bcmd
& 0x40) ? "" : "un");
646 * Kernel version specific module stuffages
649 MODULE_LICENSE("GPL");
650 MODULE_AUTHOR("Mark Ferrell <mferrell@mvista.com>");
651 MODULE_DESCRIPTION(PMC551_VERSION
);
654 * Stuff these outside the ifdef so as to not bust compiled in driver support
656 static int msize
= 0;
657 static int asize
= 0;
659 module_param(msize
, int, 0);
660 MODULE_PARM_DESC(msize
, "memory size in MiB [1 - 1024]");
661 module_param(asize
, int, 0);
662 MODULE_PARM_DESC(asize
, "aperture size, must be <= memsize [1-1024]");
665 * PMC551 Card Initialization
667 static int __init
init_pmc551(void)
669 struct pci_dev
*PCI_Device
= NULL
;
672 struct mtd_info
*mtd
;
676 msize
= (1 << (ffs(msize
) - 1)) << 20;
677 if (msize
> (1 << 30)) {
678 printk(KERN_NOTICE
"pmc551: Invalid memory size [%d]\n",
685 asize
= (1 << (ffs(asize
) - 1)) << 20;
686 if (asize
> (1 << 30)) {
687 printk(KERN_NOTICE
"pmc551: Invalid aperture size "
693 printk(KERN_INFO PMC551_VERSION
);
696 * PCU-bus chipset probe.
700 if ((PCI_Device
= pci_get_device(PCI_VENDOR_ID_V3_SEMI
,
701 PCI_DEVICE_ID_V3_SEMI_V370PDC
,
702 PCI_Device
)) == NULL
) {
706 printk(KERN_NOTICE
"pmc551: Found PCI V370PDC at 0x%llx\n",
707 (unsigned long long)pci_resource_start(PCI_Device
, 0));
710 * The PMC551 device acts VERY weird if you don't init it
711 * first. i.e. it will not correctly report devsel. If for
712 * some reason the sdram is in a wrote-protected state the
713 * device will DEVSEL when it is written to causing problems
714 * with the oldproc.c driver in
715 * some kernels (2.2.*)
717 if ((length
= fixup_pmc551(PCI_Device
)) <= 0) {
718 printk(KERN_NOTICE
"pmc551: Cannot init SDRAM\n");
723 * This is needed until the driver is capable of reading the
724 * onboard I2C SROM to discover the "real" memory size.
728 printk(KERN_NOTICE
"pmc551: Using specified memory "
729 "size 0x%x\n", length
);
734 mtd
= kzalloc(sizeof(struct mtd_info
), GFP_KERNEL
);
736 printk(KERN_NOTICE
"pmc551: Cannot allocate new MTD "
741 priv
= kzalloc(sizeof(struct mypriv
), GFP_KERNEL
);
743 printk(KERN_NOTICE
"pmc551: Cannot allocate new MTD "
749 priv
->dev
= PCI_Device
;
751 if (asize
> length
) {
752 printk(KERN_NOTICE
"pmc551: reducing aperture size to "
753 "fit %dM\n", length
>> 20);
754 priv
->asize
= asize
= length
;
755 } else if (asize
== 0 || asize
== length
) {
756 printk(KERN_NOTICE
"pmc551: Using existing aperture "
757 "size %dM\n", length
>> 20);
758 priv
->asize
= asize
= length
;
760 printk(KERN_NOTICE
"pmc551: Using specified aperture "
761 "size %dM\n", asize
>> 20);
764 priv
->start
= pci_iomap(PCI_Device
, 0, priv
->asize
);
767 printk(KERN_NOTICE
"pmc551: Unable to map IO space\n");
772 #ifdef CONFIG_MTD_PMC551_DEBUG
773 printk(KERN_DEBUG
"pmc551: setting aperture to %d\n",
774 ffs(priv
->asize
>> 20) - 1);
777 priv
->base_map0
= (PMC551_PCI_MEM_MAP_REG_EN
778 | PMC551_PCI_MEM_MAP_ENABLE
779 | (ffs(priv
->asize
>> 20) - 1) << 4);
780 priv
->curr_map0
= priv
->base_map0
;
781 pci_write_config_dword(priv
->dev
, PMC551_PCI_MEM_MAP0
,
784 #ifdef CONFIG_MTD_PMC551_DEBUG
785 printk(KERN_DEBUG
"pmc551: aperture set to %d\n",
786 (priv
->base_map0
& 0xF0) >> 4);
790 mtd
->flags
= MTD_CAP_RAM
;
791 mtd
->_erase
= pmc551_erase
;
792 mtd
->_read
= pmc551_read
;
793 mtd
->_write
= pmc551_write
;
794 mtd
->_point
= pmc551_point
;
795 mtd
->_unpoint
= pmc551_unpoint
;
797 mtd
->name
= "PMC551 RAM board";
798 mtd
->erasesize
= 0x10000;
800 mtd
->owner
= THIS_MODULE
;
802 if (mtd_device_register(mtd
, NULL
, 0)) {
803 printk(KERN_NOTICE
"pmc551: Failed to register new device\n");
804 pci_iounmap(PCI_Device
, priv
->start
);
810 /* Keep a reference as the mtd_device_register worked */
811 pci_dev_get(PCI_Device
);
813 printk(KERN_NOTICE
"Registered pmc551 memory device.\n");
814 printk(KERN_NOTICE
"Mapped %dMiB of memory from 0x%p to 0x%p\n",
816 priv
->start
, priv
->start
+ priv
->asize
);
817 printk(KERN_NOTICE
"Total memory is %d%sB\n",
818 (length
< 1024) ? length
:
819 (length
< 1048576) ? length
>> 10 : length
>> 20,
820 (length
< 1024) ? "" : (length
< 1048576) ? "Ki" : "Mi");
821 priv
->nextpmc551
= pmc551list
;
826 /* Exited early, reference left over */
828 pci_dev_put(PCI_Device
);
831 printk(KERN_NOTICE
"pmc551: not detected\n");
834 printk(KERN_NOTICE
"pmc551: %d pmc551 devices loaded\n", found
);
840 * PMC551 Card Cleanup
842 static void __exit
cleanup_pmc551(void)
845 struct mtd_info
*mtd
;
848 while ((mtd
= pmc551list
)) {
850 pmc551list
= priv
->nextpmc551
;
853 printk(KERN_DEBUG
"pmc551: unmapping %dMiB starting at "
854 "0x%p\n", priv
->asize
>> 20, priv
->start
);
855 pci_iounmap(priv
->dev
, priv
->start
);
857 pci_dev_put(priv
->dev
);
860 mtd_device_unregister(mtd
);
865 printk(KERN_NOTICE
"pmc551: %d pmc551 devices unloaded\n", found
);
868 module_init(init_pmc551
);
869 module_exit(cleanup_pmc551
);