hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
/* SPDX-License-Identifier: GPL-2.0 */
#ifndef FWH_LOCK_H
#define FWH_LOCK_H
 
 
enum fwh_lock_state {
        FWH_UNLOCKED   = 0,
   FWH_DENY_WRITE = 1,
   FWH_IMMUTABLE  = 2,
   FWH_DENY_READ  = 4,
};
 
struct fwh_xxlock_thunk {
   enum fwh_lock_state val;
   flstate_t state;
};
 
 
#define FWH_XXLOCK_ONEBLOCK_LOCK   ((struct fwh_xxlock_thunk){ FWH_DENY_WRITE, FL_LOCKING})
#define FWH_XXLOCK_ONEBLOCK_UNLOCK ((struct fwh_xxlock_thunk){ FWH_UNLOCKED,   FL_UNLOCKING})
 
/*
 * This locking/unlock is specific to firmware hub parts.  Only one
 * is known that supports the Intel command set.    Firmware
 * hub parts cannot be interleaved as they are on the LPC bus
 * so this code has not been tested with interleaved chips,
 * and will likely fail in that context.
 */
static int fwh_xxlock_oneblock(struct map_info *map, struct flchip *chip,
   unsigned long adr, int len, void *thunk)
{
   struct cfi_private *cfi = map->fldrv_priv;
   struct fwh_xxlock_thunk *xxlt = (struct fwh_xxlock_thunk *)thunk;
   int ret;
 
   /* Refuse the operation if the we cannot look behind the chip */
   if (chip->start < 0x400000) {
       pr_debug( "MTD %s(): chip->start: %lx wanted >= 0x400000\n",
           __func__, chip->start );
       return -EIO;
   }
   /*
    * lock block registers:
    * - on 64k boundariesand
    * - bit 1 set high
    * - block lock registers are 4MiB lower - overflow subtract (danger)
    *
    * The address manipulation is first done on the logical address
    * which is 0 at the start of the chip, and then the offset of
    * the individual chip is addted to it.  Any other order a weird
    * map offset could cause problems.
    */
   adr = (adr & ~0xffffUL) | 0x2;
   adr += chip->start - 0x400000;
 
   /*
    * This is easy because these are writes to registers and not writes
    * to flash memory - that means that we don't have to check status
    * and timeout.
    */
   mutex_lock(&chip->mutex);
   ret = get_chip(map, chip, adr, FL_LOCKING);
   if (ret) {
       mutex_unlock(&chip->mutex);
       return ret;
   }
 
   chip->oldstate = chip->state;
   chip->state = xxlt->state;
   map_write(map, CMD(xxlt->val), adr);
 
   /* Done and happy. */
   chip->state = chip->oldstate;
   put_chip(map, chip, adr);
   mutex_unlock(&chip->mutex);
   return 0;
}
 
 
static int fwh_lock_varsize(struct mtd_info *mtd, loff_t ofs, uint64_t len)
{
   int ret;
 
   ret = cfi_varsize_frob(mtd, fwh_xxlock_oneblock, ofs, len,
       (void *)&FWH_XXLOCK_ONEBLOCK_LOCK);
 
   return ret;
}
 
 
static int fwh_unlock_varsize(struct mtd_info *mtd, loff_t ofs, uint64_t len)
{
   int ret;
 
   ret = cfi_varsize_frob(mtd, fwh_xxlock_oneblock, ofs, len,
       (void *)&FWH_XXLOCK_ONEBLOCK_UNLOCK);
 
   return ret;
}
 
static void fixup_use_fwh_lock(struct mtd_info *mtd)
{
   printk(KERN_NOTICE "using fwh lock/unlock method\n");
   /* Setup for the chips with the fwh lock method */
   mtd->_lock   = fwh_lock_varsize;
   mtd->_unlock = fwh_unlock_varsize;
}
#endif /* FWH_LOCK_H */