12 struct fwh_xxlock_thunk {
13 enum fwh_lock_state val;
18 #define FWH_XXLOCK_ONEBLOCK_LOCK ((struct fwh_xxlock_thunk){ FWH_DENY_WRITE, FL_LOCKING})
19 #define FWH_XXLOCK_ONEBLOCK_UNLOCK ((struct fwh_xxlock_thunk){ FWH_UNLOCKED, FL_UNLOCKING})
22 * This locking/unlock is specific to firmware hub parts. Only one
23 * is known that supports the Intel command set. Firmware
24 * hub parts cannot be interleaved as they are on the LPC bus
25 * so this code has not been tested with interleaved chips,
26 * and will likely fail in that context.
28 static int fwh_xxlock_oneblock(struct map_info *map, struct flchip *chip,
29 unsigned long adr, int len, void *thunk)
31 struct cfi_private *cfi = map->fldrv_priv;
32 struct fwh_xxlock_thunk *xxlt = (struct fwh_xxlock_thunk *)thunk;
35 /* Refuse the operation if the we cannot look behind the chip */
36 if (chip->start < 0x400000) {
37 DEBUG( MTD_DEBUG_LEVEL3,
38 "MTD %s(): chip->start: %lx wanted >= 0x400000\n",
39 __func__, chip->start );
43 * lock block registers:
44 * - on 64k boundariesand
46 * - block lock registers are 4MiB lower - overflow subtract (danger)
48 * The address manipulation is first done on the logical address
49 * which is 0 at the start of the chip, and then the offset of
50 * the individual chip is addted to it. Any other order a weird
51 * map offset could cause problems.
53 adr = (adr & ~0xffffUL) | 0x2;
54 adr += chip->start - 0x400000;
57 * This is easy because these are writes to registers and not writes
58 * to flash memory - that means that we don't have to check status
61 mutex_lock(&chip->mutex);
62 ret = get_chip(map, chip, adr, FL_LOCKING);
64 mutex_unlock(&chip->mutex);
68 chip->oldstate = chip->state;
69 chip->state = xxlt->state;
70 map_write(map, CMD(xxlt->val), adr);
73 chip->state = chip->oldstate;
74 put_chip(map, chip, adr);
75 mutex_unlock(&chip->mutex);
80 static int fwh_lock_varsize(struct mtd_info *mtd, loff_t ofs, uint64_t len)
84 ret = cfi_varsize_frob(mtd, fwh_xxlock_oneblock, ofs, len,
85 (void *)&FWH_XXLOCK_ONEBLOCK_LOCK);
91 static int fwh_unlock_varsize(struct mtd_info *mtd, loff_t ofs, uint64_t len)
95 ret = cfi_varsize_frob(mtd, fwh_xxlock_oneblock, ofs, len,
96 (void *)&FWH_XXLOCK_ONEBLOCK_UNLOCK);
101 static void fixup_use_fwh_lock(struct mtd_info *mtd, void *param)
103 printk(KERN_NOTICE "using fwh lock/unlock method\n");
104 /* Setup for the chips with the fwh lock method */
105 mtd->lock = fwh_lock_varsize;
106 mtd->unlock = fwh_unlock_varsize;
108 #endif /* FWH_LOCK_H */