forked from flashrom/flashrom
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathwriteprotect_ranges.c
More file actions
136 lines (118 loc) · 3.98 KB
/
writeprotect_ranges.c
File metadata and controls
136 lines (118 loc) · 3.98 KB
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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
/*
* This file is part of the flashrom project.
*
* SPDX-License-Identifier: GPL-2.0-or-later
* SPDX-FileCopyrightText: 2021 Google LLC
*/
#include "writeprotect.h"
#include "chipdrivers.h"
#include "helpers.h"
static void decode_range_generic(size_t *start, size_t *len, const struct wp_bits *bits, size_t chip_len,
bool fixed_block_len, bool apply_cmp_to_bp, int coeff_offset)
{
const bool cmp = bits->cmp_bit_present && bits->cmp == 1;
/* Interpret BP bits as an integer */
size_t bp = 0;
size_t bp_max = 0;
for (size_t i = 0; i < bits->bp_bit_count; i++) {
bp |= bits->bp[i] << i;
bp_max |= 1 << i;
}
/*
* Most chips: the CMP bit only negates the range.
*
* Some MX chips: the CMP bit negates the BP bits and the range.
* (CMP bit is often the MSB BP bit in such chips.)
*/
if (cmp && apply_cmp_to_bp)
bp ^= bp_max;
if (bp == 0) {
/* Special case: all BP bits are 0 => no write protection */
*len = 0;
} else if (bp == bp_max) {
/* Special case: all BP bits are 1 => full write protection */
*len = chip_len;
} else {
/*
* Usual case: the BP bits encode a coefficient in the form
* `coeff = 2 ** (bp - offset)` where `offset == 1`.
*
* The range's length is given by multiplying the coefficient
* by a base unit, usually a 4K sector or a 64K block.
*/
size_t coeff = 1 << (bp - coeff_offset);
size_t max_coeff = 1 << (bp_max - coeff_offset - 1);
size_t sector_len = 4 * KiB;
size_t default_block_len = 64 * KiB;
if (bits->sec_bit_present && bits->sec == 1) {
/*
* SEC=1, protect 4K sectors. Flash chips clamp the
* protection length at 32K, probably to avoid overlap
* with the SEC=0 case.
*/
*len = min(sector_len * coeff, default_block_len / 2);
} else {
/*
* SEC=0 or is not present, protect blocks.
*/
size_t block_len = default_block_len;
/*
* With very large chips, the 'block' size can be
* larger than 64K. This occurs when a larger block
* size is needed so that half the chip can be
* protected by the maximum possible coefficient.
*/
if (!fixed_block_len) {
size_t min_block_len = chip_len / 2 / max_coeff;
block_len = max(min_block_len, default_block_len);
}
*len = min(block_len * coeff, chip_len);
}
}
/* Apply TB bit */
bool protect_top = bits->tb_bit_present ? (bits->tb == 0) : 1;
/* Apply CMP bit */
if (cmp) {
*len = chip_len - *len;
protect_top = !protect_top;
}
/* Calculate start address, ensuring that empty ranges start at 0 */
if (protect_top && *len > 0)
*start = chip_len - *len;
else
*start = 0;
}
/*
* Protection range calculation that works with many common SPI flash chips.
*/
void decode_range_spi25(size_t *start, size_t *len, const struct wp_bits *bits, size_t chip_len)
{
decode_range_generic(start, len, bits, chip_len,
/*fixed_block_len=*/false, /*apply_cmp_to_bp=*/false, /*coeff_offset=*/1);
}
/*
* Do not adjust block size to be able to fill half of the chip.
*/
void decode_range_spi25_64k_block(size_t *start, size_t *len, const struct wp_bits *bits, size_t chip_len)
{
decode_range_generic(start, len, bits, chip_len,
/*fixed_block_len=*/true, /*apply_cmp_to_bp=*/false, /*coeff_offset=*/1);
}
/*
* Inverts BP bits when CMP is set and treats all ones in BP bits as a request to protect whole chip regardless
* of the CMP bit.
*/
void decode_range_spi25_bit_cmp(size_t *start, size_t *len, const struct wp_bits *bits, size_t chip_len)
{
decode_range_generic(start, len, bits, chip_len,
/*fixed_block_len=*/false, /*apply_cmp_to_bp=*/true, /*coeff_offset=*/1);
}
/*
* This multiplies coefficient by 2. To be used with chips which have more BP bits than needed, such that the
* most significant BP bit effectively acts as "protect whole chip" flag.
*/
void decode_range_spi25_2x_block(size_t *start, size_t *len, const struct wp_bits *bits, size_t chip_len)
{
decode_range_generic(start, len, bits, chip_len,
/*fixed_block_len=*/false, /*apply_cmp_to_bp=*/false, /*coeff_offset=*/0);
}