|
42 | 42 | */ |
43 | 43 | static rt_uint32_t GetSector(rt_uint32_t Address) |
44 | 44 | { |
45 | | - uint32_t sector = 0; |
| 45 | + uint32_t sector = 0; |
46 | 46 |
|
47 | 47 | #if defined (FLASH_OPTCR_nDBANK) |
48 | | - FLASH_OBProgramInitTypeDef OBInit; |
49 | | - uint32_t nbank = 0; |
50 | | - |
51 | | - //get duel bank ability:nDBANK(Bit29) |
52 | | - HAL_FLASHEx_OBGetConfig(&OBInit); |
53 | | - nbank = ((OBInit.USERConfig & 0x20000000U) >> 29); |
54 | | - //1:single bank mode |
55 | | - if(1 == nbank) |
56 | | - { |
| 48 | + FLASH_OBProgramInitTypeDef OBInit; |
| 49 | + uint32_t nbank = 0; |
| 50 | + |
| 51 | + //get duel bank ability:nDBANK(Bit29) |
| 52 | + HAL_FLASHEx_OBGetConfig(&OBInit); |
| 53 | + nbank = ((OBInit.USERConfig & 0x20000000U) >> 29); |
| 54 | + //1:single bank mode |
| 55 | + if(1 == nbank) |
| 56 | + { |
| 57 | + if((Address < ADDR_FLASH_SECTOR_1) && (Address >= ADDR_FLASH_SECTOR_0)) |
| 58 | + { |
| 59 | + sector = FLASH_SECTOR_0; |
| 60 | + } |
| 61 | + else if((Address < ADDR_FLASH_SECTOR_2) && (Address >= ADDR_FLASH_SECTOR_1)) |
| 62 | + { |
| 63 | + sector = FLASH_SECTOR_1; |
| 64 | + } |
| 65 | + else if((Address < ADDR_FLASH_SECTOR_3) && (Address >= ADDR_FLASH_SECTOR_2)) |
| 66 | + { |
| 67 | + sector = FLASH_SECTOR_2; |
| 68 | + } |
| 69 | + else if((Address < ADDR_FLASH_SECTOR_4) && (Address >= ADDR_FLASH_SECTOR_3)) |
| 70 | + { |
| 71 | + sector = FLASH_SECTOR_3; |
| 72 | + } |
| 73 | + else if((Address < ADDR_FLASH_SECTOR_5) && (Address >= ADDR_FLASH_SECTOR_4)) |
| 74 | + { |
| 75 | + sector = FLASH_SECTOR_4; |
| 76 | + } |
| 77 | + else if((Address < ADDR_FLASH_SECTOR_6) && (Address >= ADDR_FLASH_SECTOR_5)) |
| 78 | + { |
| 79 | + sector = FLASH_SECTOR_5; |
| 80 | + } |
| 81 | + else if((Address < ADDR_FLASH_SECTOR_7) && (Address >= ADDR_FLASH_SECTOR_6)) |
| 82 | + { |
| 83 | + sector = FLASH_SECTOR_6; |
| 84 | + } |
| 85 | + else if((Address < ADDR_FLASH_SECTOR_8) && (Address >= ADDR_FLASH_SECTOR_7)) |
| 86 | + { |
| 87 | + sector = FLASH_SECTOR_7; |
| 88 | + } |
| 89 | + else if((Address < ADDR_FLASH_SECTOR_9) && (Address >= ADDR_FLASH_SECTOR_8)) |
| 90 | + { |
| 91 | + sector = FLASH_SECTOR_8; |
| 92 | + } |
| 93 | + else if((Address < ADDR_FLASH_SECTOR_10) && (Address >= ADDR_FLASH_SECTOR_9)) |
| 94 | + { |
| 95 | + sector = FLASH_SECTOR_9; |
| 96 | + } |
| 97 | + else if((Address < ADDR_FLASH_SECTOR_11) && (Address >= ADDR_FLASH_SECTOR_10)) |
| 98 | + { |
| 99 | + sector = FLASH_SECTOR_10; |
| 100 | + } |
| 101 | + else |
| 102 | + { |
| 103 | + sector = FLASH_SECTOR_11; |
| 104 | + } |
| 105 | + } |
| 106 | + else //0:dual bank mode |
| 107 | + { |
| 108 | + RT_ASSERT("rtthread doesn't support duel bank mode yet!"); |
| 109 | + } |
| 110 | +#else //no dual bank ability |
57 | 111 | if((Address < ADDR_FLASH_SECTOR_1) && (Address >= ADDR_FLASH_SECTOR_0)) |
58 | 112 | { |
59 | | - sector = FLASH_SECTOR_0; |
| 113 | + sector = FLASH_SECTOR_0; |
60 | 114 | } |
61 | 115 | else if((Address < ADDR_FLASH_SECTOR_2) && (Address >= ADDR_FLASH_SECTOR_1)) |
62 | 116 | { |
63 | | - sector = FLASH_SECTOR_1; |
| 117 | + sector = FLASH_SECTOR_1; |
64 | 118 | } |
65 | 119 | else if((Address < ADDR_FLASH_SECTOR_3) && (Address >= ADDR_FLASH_SECTOR_2)) |
66 | 120 | { |
67 | | - sector = FLASH_SECTOR_2; |
| 121 | + sector = FLASH_SECTOR_2; |
68 | 122 | } |
69 | 123 | else if((Address < ADDR_FLASH_SECTOR_4) && (Address >= ADDR_FLASH_SECTOR_3)) |
70 | 124 | { |
71 | | - sector = FLASH_SECTOR_3; |
| 125 | + sector = FLASH_SECTOR_3; |
72 | 126 | } |
73 | 127 | else if((Address < ADDR_FLASH_SECTOR_5) && (Address >= ADDR_FLASH_SECTOR_4)) |
74 | 128 | { |
75 | | - sector = FLASH_SECTOR_4; |
| 129 | + sector = FLASH_SECTOR_4; |
76 | 130 | } |
77 | 131 | else if((Address < ADDR_FLASH_SECTOR_6) && (Address >= ADDR_FLASH_SECTOR_5)) |
78 | 132 | { |
79 | | - sector = FLASH_SECTOR_5; |
| 133 | + sector = FLASH_SECTOR_5; |
80 | 134 | } |
81 | 135 | else if((Address < ADDR_FLASH_SECTOR_7) && (Address >= ADDR_FLASH_SECTOR_6)) |
82 | 136 | { |
83 | | - sector = FLASH_SECTOR_6; |
| 137 | + sector = FLASH_SECTOR_6; |
84 | 138 | } |
85 | 139 | else if((Address < ADDR_FLASH_SECTOR_8) && (Address >= ADDR_FLASH_SECTOR_7)) |
86 | 140 | { |
87 | | - sector = FLASH_SECTOR_7; |
| 141 | + sector = FLASH_SECTOR_7; |
88 | 142 | } |
89 | 143 | else if((Address < ADDR_FLASH_SECTOR_9) && (Address >= ADDR_FLASH_SECTOR_8)) |
90 | 144 | { |
91 | | - sector = FLASH_SECTOR_8; |
| 145 | + sector = FLASH_SECTOR_8; |
92 | 146 | } |
93 | 147 | else if((Address < ADDR_FLASH_SECTOR_10) && (Address >= ADDR_FLASH_SECTOR_9)) |
94 | 148 | { |
95 | | - sector = FLASH_SECTOR_9; |
| 149 | + sector = FLASH_SECTOR_9; |
96 | 150 | } |
97 | 151 | else if((Address < ADDR_FLASH_SECTOR_11) && (Address >= ADDR_FLASH_SECTOR_10)) |
98 | 152 | { |
99 | | - sector = FLASH_SECTOR_10; |
| 153 | + sector = FLASH_SECTOR_10; |
100 | 154 | } |
101 | 155 | else |
102 | 156 | { |
103 | | - sector = FLASH_SECTOR_11; |
| 157 | + sector = FLASH_SECTOR_11; |
104 | 158 | } |
105 | | - } |
106 | | - else //0:dual bank mode |
107 | | - { |
108 | | - RT_ASSERT("rtthread doesn't support duel bank mode yet!"); |
109 | | - } |
110 | | -#else //no dual bank ability |
111 | | - if((Address < ADDR_FLASH_SECTOR_1) && (Address >= ADDR_FLASH_SECTOR_0)) |
112 | | - { |
113 | | - sector = FLASH_SECTOR_0; |
114 | | - } |
115 | | - else if((Address < ADDR_FLASH_SECTOR_2) && (Address >= ADDR_FLASH_SECTOR_1)) |
116 | | - { |
117 | | - sector = FLASH_SECTOR_1; |
118 | | - } |
119 | | - else if((Address < ADDR_FLASH_SECTOR_3) && (Address >= ADDR_FLASH_SECTOR_2)) |
120 | | - { |
121 | | - sector = FLASH_SECTOR_2; |
122 | | - } |
123 | | - else if((Address < ADDR_FLASH_SECTOR_4) && (Address >= ADDR_FLASH_SECTOR_3)) |
124 | | - { |
125 | | - sector = FLASH_SECTOR_3; |
126 | | - } |
127 | | - else if((Address < ADDR_FLASH_SECTOR_5) && (Address >= ADDR_FLASH_SECTOR_4)) |
128 | | - { |
129 | | - sector = FLASH_SECTOR_4; |
130 | | - } |
131 | | - else if((Address < ADDR_FLASH_SECTOR_6) && (Address >= ADDR_FLASH_SECTOR_5)) |
132 | | - { |
133 | | - sector = FLASH_SECTOR_5; |
134 | | - } |
135 | | - else if((Address < ADDR_FLASH_SECTOR_7) && (Address >= ADDR_FLASH_SECTOR_6)) |
136 | | - { |
137 | | - sector = FLASH_SECTOR_6; |
138 | | - } |
139 | | - else if((Address < ADDR_FLASH_SECTOR_8) && (Address >= ADDR_FLASH_SECTOR_7)) |
140 | | - { |
141 | | - sector = FLASH_SECTOR_7; |
142 | | - } |
143 | | - else if((Address < ADDR_FLASH_SECTOR_9) && (Address >= ADDR_FLASH_SECTOR_8)) |
144 | | - { |
145 | | - sector = FLASH_SECTOR_8; |
146 | | - } |
147 | | - else if((Address < ADDR_FLASH_SECTOR_10) && (Address >= ADDR_FLASH_SECTOR_9)) |
148 | | - { |
149 | | - sector = FLASH_SECTOR_9; |
150 | | - } |
151 | | - else if((Address < ADDR_FLASH_SECTOR_11) && (Address >= ADDR_FLASH_SECTOR_10)) |
152 | | - { |
153 | | - sector = FLASH_SECTOR_10; |
154 | | - } |
155 | | - else |
156 | | - { |
157 | | - sector = FLASH_SECTOR_11; |
158 | | - } |
159 | 159 | #endif |
160 | | - return sector; |
| 160 | + return sector; |
161 | 161 | } |
162 | 162 |
|
163 | 163 |
|
|
0 commit comments