Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
69f34c98 | 2 | * NV-RAM memory access on autcpu12 |
1da177e4 LT |
3 | * (C) 2002 Thomas Gleixner (gleixner@autronix.de) |
4 | * | |
1da177e4 LT |
5 | * This program is free software; you can redistribute it and/or modify |
6 | * it under the terms of the GNU General Public License as published by | |
7 | * the Free Software Foundation; either version 2 of the License, or | |
8 | * (at your option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
1da177e4 | 18 | */ |
b0de774c | 19 | #include <linux/err.h> |
ce55754c | 20 | #include <linux/sizes.h> |
1da177e4 | 21 | |
1da177e4 LT |
22 | #include <linux/types.h> |
23 | #include <linux/kernel.h> | |
1da177e4 | 24 | #include <linux/init.h> |
ce55754c AS |
25 | #include <linux/device.h> |
26 | #include <linux/module.h> | |
27 | #include <linux/platform_device.h> | |
28 | ||
1da177e4 LT |
29 | #include <linux/mtd/mtd.h> |
30 | #include <linux/mtd/map.h> | |
1da177e4 | 31 | |
ce55754c AS |
32 | struct autcpu12_nvram_priv { |
33 | struct mtd_info *mtd; | |
34 | struct map_info map; | |
1da177e4 LT |
35 | }; |
36 | ||
06f25510 | 37 | static int autcpu12_nvram_probe(struct platform_device *pdev) |
1da177e4 | 38 | { |
d1f55c68 | 39 | map_word tmp, save0, save1; |
ce55754c AS |
40 | struct resource *res; |
41 | struct autcpu12_nvram_priv *priv; | |
1da177e4 | 42 | |
ce55754c AS |
43 | priv = devm_kzalloc(&pdev->dev, |
44 | sizeof(struct autcpu12_nvram_priv), GFP_KERNEL); | |
45 | if (!priv) | |
46 | return -ENOMEM; | |
47 | ||
48 | platform_set_drvdata(pdev, priv); | |
49 | ||
50 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
51 | if (!res) { | |
52 | dev_err(&pdev->dev, "failed to get memory resource\n"); | |
6f12f59a | 53 | return -ENOENT; |
ce55754c AS |
54 | } |
55 | ||
56 | priv->map.bankwidth = 4; | |
57 | priv->map.phys = res->start; | |
58 | priv->map.size = resource_size(res); | |
b0de774c | 59 | priv->map.virt = devm_ioremap_resource(&pdev->dev, res); |
ce55754c | 60 | strcpy((char *)priv->map.name, res->name); |
b0de774c TR |
61 | if (IS_ERR(priv->map.virt)) |
62 | return PTR_ERR(priv->map.virt); | |
ce55754c AS |
63 | |
64 | simple_map_init(&priv->map); | |
1da177e4 | 65 | |
69f34c98 TG |
66 | /* |
67 | * Check for 32K/128K | |
68 | * read ofs 0 | |
69 | * read ofs 0x10000 | |
1da177e4 LT |
70 | * Write complement to ofs 0x100000 |
71 | * Read and check result on ofs 0x0 | |
72 | * Restore contents | |
73 | */ | |
ce55754c AS |
74 | save0 = map_read(&priv->map, 0); |
75 | save1 = map_read(&priv->map, 0x10000); | |
d1f55c68 | 76 | tmp.x[0] = ~save0.x[0]; |
ce55754c AS |
77 | map_write(&priv->map, tmp, 0x10000); |
78 | tmp = map_read(&priv->map, 0); | |
79 | /* if we find this pattern on 0x0, we have 32K size */ | |
80 | if (!map_word_equal(&priv->map, tmp, save0)) { | |
81 | map_write(&priv->map, save0, 0x0); | |
82 | priv->map.size = SZ_32K; | |
83 | } else | |
84 | map_write(&priv->map, save1, 0x10000); | |
85 | ||
86 | priv->mtd = do_map_probe("map_ram", &priv->map); | |
87 | if (!priv->mtd) { | |
88 | dev_err(&pdev->dev, "probing failed\n"); | |
6f12f59a | 89 | return -ENXIO; |
1da177e4 LT |
90 | } |
91 | ||
ce55754c AS |
92 | priv->mtd->owner = THIS_MODULE; |
93 | priv->mtd->erasesize = 16; | |
94 | priv->mtd->dev.parent = &pdev->dev; | |
95 | if (!mtd_device_register(priv->mtd, NULL, 0)) { | |
96 | dev_info(&pdev->dev, | |
97 | "NV-RAM device size %ldKiB registered on AUTCPU12\n", | |
98 | priv->map.size / SZ_1K); | |
99 | return 0; | |
1da177e4 LT |
100 | } |
101 | ||
ce55754c AS |
102 | map_destroy(priv->mtd); |
103 | dev_err(&pdev->dev, "NV-RAM device addition failed\n"); | |
6f12f59a | 104 | return -ENOMEM; |
1da177e4 LT |
105 | } |
106 | ||
810b7e06 | 107 | static int autcpu12_nvram_remove(struct platform_device *pdev) |
1da177e4 | 108 | { |
ce55754c AS |
109 | struct autcpu12_nvram_priv *priv = platform_get_drvdata(pdev); |
110 | ||
111 | mtd_device_unregister(priv->mtd); | |
112 | map_destroy(priv->mtd); | |
ce55754c AS |
113 | |
114 | return 0; | |
1da177e4 LT |
115 | } |
116 | ||
ce55754c AS |
117 | static struct platform_driver autcpu12_nvram_driver = { |
118 | .driver = { | |
119 | .name = "autcpu12_nvram", | |
120 | .owner = THIS_MODULE, | |
121 | }, | |
122 | .probe = autcpu12_nvram_probe, | |
5153b88c | 123 | .remove = autcpu12_nvram_remove, |
ce55754c AS |
124 | }; |
125 | module_platform_driver(autcpu12_nvram_driver); | |
1da177e4 LT |
126 | |
127 | MODULE_AUTHOR("Thomas Gleixner"); | |
ce55754c | 128 | MODULE_DESCRIPTION("autcpu12 NVRAM map driver"); |
1da177e4 | 129 | MODULE_LICENSE("GPL"); |