?? fads.c
字號:
#include <linux/module.h>#include <linux/types.h>#include <linux/kernel.h>#include <asm/io.h>#include <linux/mtd/mtd.h>#include <linux/mtd/map.h>#include <linux/mtd/partitions.h>#include <linux/config.h>#define WINDOW_ADDR 0x3000000#define WINDOW_SIZE 0x400000#define BUSWIDTH 1static struct mtd_info *mymtd;__u8 fads_read8(struct map_info *map, unsigned long ofs){ return __raw_readb(map->map_priv_1 + ofs);}__u16 fads_read16(struct map_info *map, unsigned long ofs){ return __raw_readw(map->map_priv_1 + ofs);}__u32 fads_read32(struct map_info *map, unsigned long ofs){ return __raw_readl(map->map_priv_1 + ofs);}void fads_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len){ memcpy_fromio(to, map->map_priv_1 + from, len);}void fads_write8(struct map_info *map, __u8 d, unsigned long adr){ __raw_writeb(d, map->map_priv_1 + adr); mb();}void fads_write16(struct map_info *map, __u16 d, unsigned long adr){ __raw_writew(d, map->map_priv_1 + adr); mb();}void fads_write32(struct map_info *map, __u32 d, unsigned long adr){ __raw_writel(d, map->map_priv_1 + adr); mb();}void fads_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len){ memcpy_toio(map->map_priv_1 + to, from, len);}struct map_info fads_map = { name: "Intel flash device", size: WINDOW_SIZE, buswidth: BUSWIDTH, read8: fads_read8, read16: fads_read16, read32: fads_read32, copy_from: fads_copy_from, write8: fads_write8, write16: fads_write16, write32: fads_write32, copy_to: fads_copy_to};/* * MTD PARTITIONING STUFF */static struct mtd_partition fads_partitions[] = { {name: "kernel(512K)",size: 0x80000,offset: 0x0 }, {name: "user(3584K)",size: 0x380000,offset: 0x80000 }};int __init init_fads(void){ printk(KERN_NOTICE "Intel flash device: %x at %x\n", WINDOW_SIZE, WINDOW_ADDR); fads_map.map_priv_1 = (unsigned long)ioremap(WINDOW_ADDR, WINDOW_SIZE); if (!fads_map.map_priv_1) { printk("Failed to ioremap\n"); return -EIO; } mymtd = do_map_probe("cfi_probe", &fads_map); if (mymtd) { mymtd->module = THIS_MODULE; return add_mtd_partitions(mymtd,fads_partitions, sizeof(fads_partitions)/ sizeof(struct mtd_partition)); } iounmap((void *)fads_map.map_priv_1); return -ENXIO;}static void __exit cleanup_fads(void){ if (mymtd) { del_mtd_device(mymtd); map_destroy(mymtd); } if (fads_map.map_priv_1) { iounmap((void *)fads_map.map_priv_1); fads_map.map_priv_1 = 0; }}module_init(init_fads);module_exit(cleanup_fads);MODULE_LICENSE("GPL");MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");MODULE_DESCRIPTION("Generic configurable MTD map driver");
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -