| <!DOCTYPE HTML PUBLIC "-//W3C//DTD HTML 4.01 Transitional//EN"> |
| |
| <html lang="en"> |
| |
| <head> |
| <meta http-equiv="Content-Type" content="text/html; charset=UTF-8"> |
| <title>LCOV - skiboot.info - libflash/libflash.c</title> |
| <link rel="stylesheet" type="text/css" href="../gcov.css"> |
| </head> |
| |
| <body> |
| |
| <table width="100%" border=0 cellspacing=0 cellpadding=0> |
| <tr><td class="title">LCOV - code coverage report</td></tr> |
| <tr><td class="ruler"><img src="../glass.png" width=3 height=3 alt=""></td></tr> |
| |
| <tr> |
| <td width="100%"> |
| <table cellpadding=1 border=0 width="100%"> |
| <tr> |
| <td width="10%" class="headerItem">Current view:</td> |
| <td width="10%" class="headerValue"><a href="../index.html">top level</a> - <a href="index.html">libflash</a> - libflash.c<span style="font-size: 80%;"> (source / <a href="libflash.c.func-c.html">functions</a>)</span></td> |
| <td width="5%"></td> |
| <td width="5%"></td> |
| <td width="5%" class="headerCovTableHead">Coverage</td> |
| <td width="5%" class="headerCovTableHead" title="Covered + Uncovered code">Total</td> |
| <td width="5%" class="headerCovTableHead" title="Exercised code only">Hit</td> |
| </tr> |
| <tr> |
| <td class="headerItem">Test:</td> |
| <td class="headerValue">skiboot.info</td> |
| <td></td> |
| <td class="headerItem">Lines:</td> |
| <td class="headerCovTableEntryLo">51.9 %</td> |
| <td class="headerCovTableEntry">462</td> |
| <td class="headerCovTableEntry">240</td> |
| </tr> |
| <tr> |
| <td class="headerItem">Test Date:</td> |
| <td class="headerValue">2025-06-27 16:54:26</td> |
| <td></td> |
| <td class="headerItem">Functions:</td> |
| <td class="headerCovTableEntryMed">75.0 %</td> |
| <td class="headerCovTableEntry">24</td> |
| <td class="headerCovTableEntry">18</td> |
| </tr> |
| <tr> |
| <td></td> |
| <td></td> |
| <td></td> |
| <td class="headerItem">Branches:</td> |
| <td class="headerCovTableEntryHi">-</td> |
| <td class="headerCovTableEntry">0</td> |
| <td class="headerCovTableEntry">0</td> |
| </tr> |
| <tr><td><img src="../glass.png" width=3 height=3 alt=""></td></tr> |
| </table> |
| </td> |
| </tr> |
| |
| <tr><td class="ruler"><img src="../glass.png" width=3 height=3 alt=""></td></tr> |
| </table> |
| |
| <table cellpadding=0 cellspacing=0 border=0> |
| <tr> |
| <td><br></td> |
| </tr> |
| <tr> |
| <td> |
| <pre class="sourceHeading"> Branch data Line data Source code</pre> |
| <pre class="source"> |
| <span id="L1"><span class="lineNum"> 1</span> : : // SPDX-License-Identifier: Apache-2.0 OR GPL-2.0-or-later</span> |
| <span id="L2"><span class="lineNum"> 2</span> : : /* Copyright 2013-2017 IBM Corp. */</span> |
| <span id="L3"><span class="lineNum"> 3</span> : : </span> |
| <span id="L4"><span class="lineNum"> 4</span> : : #include <stdlib.h></span> |
| <span id="L5"><span class="lineNum"> 5</span> : : #include <stdio.h></span> |
| <span id="L6"><span class="lineNum"> 6</span> : : #include <string.h></span> |
| <span id="L7"><span class="lineNum"> 7</span> : : #include <inttypes.h></span> |
| <span id="L8"><span class="lineNum"> 8</span> : : </span> |
| <span id="L9"><span class="lineNum"> 9</span> : : #include "libflash.h"</span> |
| <span id="L10"><span class="lineNum"> 10</span> : : #include "libflash-priv.h"</span> |
| <span id="L11"><span class="lineNum"> 11</span> : : #include "ecc.h"</span> |
| <span id="L12"><span class="lineNum"> 12</span> : : #include "blocklevel.h"</span> |
| <span id="L13"><span class="lineNum"> 13</span> : : </span> |
| <span id="L14"><span class="lineNum"> 14</span> : : static const struct flash_info flash_info[] = {</span> |
| <span id="L15"><span class="lineNum"> 15</span> : : { 0xc22018, 0x01000000, FL_ERASE_ALL | FL_CAN_4B, "Macronix MXxxL12835F"},</span> |
| <span id="L16"><span class="lineNum"> 16</span> : : { 0xc22019, 0x02000000, FL_ERASE_ALL | FL_CAN_4B, "Macronix MXxxL25635F"},</span> |
| <span id="L17"><span class="lineNum"> 17</span> : : { 0xc2201a, 0x04000000, FL_ERASE_ALL | FL_CAN_4B, "Macronix MXxxL51235F"},</span> |
| <span id="L18"><span class="lineNum"> 18</span> : : { 0xc2201b, 0x08000000, FL_ERASE_ALL | FL_CAN_4B, "Macronix MX66L1G45G"},</span> |
| <span id="L19"><span class="lineNum"> 19</span> : : { 0xef4018, 0x01000000, FL_ERASE_ALL, "Winbond W25Q128BV" },</span> |
| <span id="L20"><span class="lineNum"> 20</span> : : { 0xef4019, 0x02000000, FL_ERASE_ALL | FL_ERASE_64K | FL_CAN_4B |</span> |
| <span id="L21"><span class="lineNum"> 21</span> : : FL_ERASE_BULK,</span> |
| <span id="L22"><span class="lineNum"> 22</span> : : "Winbond W25Q256BV"},</span> |
| <span id="L23"><span class="lineNum"> 23</span> : : { 0x20ba20, 0x04000000, FL_ERASE_4K | FL_ERASE_64K | FL_CAN_4B |</span> |
| <span id="L24"><span class="lineNum"> 24</span> : : FL_ERASE_BULK | FL_MICRON_BUGS,</span> |
| <span id="L25"><span class="lineNum"> 25</span> : : "Micron N25Qx512Ax" },</span> |
| <span id="L26"><span class="lineNum"> 26</span> : : { 0x20ba19, 0x02000000, FL_ERASE_4K | FL_ERASE_64K | FL_CAN_4B |</span> |
| <span id="L27"><span class="lineNum"> 27</span> : : FL_ERASE_BULK | FL_MICRON_BUGS,</span> |
| <span id="L28"><span class="lineNum"> 28</span> : : "Micron N25Q256Ax" },</span> |
| <span id="L29"><span class="lineNum"> 29</span> : : { 0x1940ef, 0x02000000, FL_ERASE_4K | FL_ERASE_64K | FL_CAN_4B |</span> |
| <span id="L30"><span class="lineNum"> 30</span> : : FL_ERASE_BULK | FL_MICRON_BUGS,</span> |
| <span id="L31"><span class="lineNum"> 31</span> : : "Micron N25Qx256Ax" },</span> |
| <span id="L32"><span class="lineNum"> 32</span> : : { 0x4d5444, 0x02000000, FL_ERASE_ALL | FL_CAN_4B, "File Abstraction"},</span> |
| <span id="L33"><span class="lineNum"> 33</span> : : { 0x55aa55, 0x00100000, FL_ERASE_ALL | FL_CAN_4B, "TEST_FLASH" },</span> |
| <span id="L34"><span class="lineNum"> 34</span> : : { 0xaa55aa, 0x02000000, FL_ERASE_ALL | FL_CAN_4B, "EMULATED_FLASH"},</span> |
| <span id="L35"><span class="lineNum"> 35</span> : : };</span> |
| <span id="L36"><span class="lineNum"> 36</span> : : </span> |
| <span id="L37"><span class="lineNum"> 37</span> : : struct flash_chip {</span> |
| <span id="L38"><span class="lineNum"> 38</span> : : struct spi_flash_ctrl *ctrl; /* Controller */</span> |
| <span id="L39"><span class="lineNum"> 39</span> : : struct flash_info info; /* Flash info */</span> |
| <span id="L40"><span class="lineNum"> 40</span> : : uint32_t tsize; /* Corrected flash size */</span> |
| <span id="L41"><span class="lineNum"> 41</span> : : uint32_t min_erase_mask; /* Minimum erase size */</span> |
| <span id="L42"><span class="lineNum"> 42</span> : : bool mode_4b; /* Flash currently in 4b mode */</span> |
| <span id="L43"><span class="lineNum"> 43</span> : : struct flash_req *cur_req; /* Current request */</span> |
| <span id="L44"><span class="lineNum"> 44</span> : : void *smart_buf; /* Buffer for smart writes */</span> |
| <span id="L45"><span class="lineNum"> 45</span> : : struct blocklevel_device bl;</span> |
| <span id="L46"><span class="lineNum"> 46</span> : : };</span> |
| <span id="L47"><span class="lineNum"> 47</span> : : </span> |
| <span id="L48"><span class="lineNum"> 48</span> : : #ifndef __SKIBOOT__</span> |
| <span id="L49"><span class="lineNum"> 49</span> : : bool libflash_debug;</span> |
| <span id="L50"><span class="lineNum"> 50</span> : : #endif</span> |
| <span id="L51"><span class="lineNum"> 51</span> : : </span> |
| <span id="L52"><span class="lineNum"> 52</span> :<span class="tlaGNC tlaBgGNC"> 24353 : int fl_read_stat(struct spi_flash_ctrl *ct, uint8_t *stat)</span></span> |
| <span id="L53"><span class="lineNum"> 53</span> : : {</span> |
| <span id="L54"><span class="lineNum"> 54</span> :<span class="tlaGNC"> 24353 : return ct->cmd_rd(ct, CMD_RDSR, false, 0, stat, 1);</span></span> |
| <span id="L55"><span class="lineNum"> 55</span> : : }</span> |
| <span id="L56"><span class="lineNum"> 56</span> : : </span> |
| <span id="L57"><span class="lineNum"> 57</span> :<span class="tlaUNC tlaBgUNC"> 0 : static void fl_micron_status(struct spi_flash_ctrl *ct)</span></span> |
| <span id="L58"><span class="lineNum"> 58</span> : : {</span> |
| <span id="L59"><span class="lineNum"> 59</span> :<span class="tlaUNC"> 0 : uint8_t flst;</span></span> |
| <span id="L60"><span class="lineNum"> 60</span> : : </span> |
| <span id="L61"><span class="lineNum"> 61</span> : : /*</span> |
| <span id="L62"><span class="lineNum"> 62</span> : : * After a success status on a write or erase, we</span> |
| <span id="L63"><span class="lineNum"> 63</span> : : * need to do that command or some chip variants will</span> |
| <span id="L64"><span class="lineNum"> 64</span> : : * lock</span> |
| <span id="L65"><span class="lineNum"> 65</span> : : */</span> |
| <span id="L66"><span class="lineNum"> 66</span> :<span class="tlaUNC"> 0 : ct->cmd_rd(ct, CMD_MIC_RDFLST, false, 0, &flst, 1);</span></span> |
| <span id="L67"><span class="lineNum"> 67</span> :<span class="tlaUNC"> 0 : }</span></span> |
| <span id="L68"><span class="lineNum"> 68</span> : : </span> |
| <span id="L69"><span class="lineNum"> 69</span> : : /* Synchronous write completion, probably need a yield hook */</span> |
| <span id="L70"><span class="lineNum"> 70</span> :<span class="tlaGNC tlaBgGNC"> 16234 : int fl_sync_wait_idle(struct spi_flash_ctrl *ct)</span></span> |
| <span id="L71"><span class="lineNum"> 71</span> : : {</span> |
| <span id="L72"><span class="lineNum"> 72</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint8_t stat;</span></span> |
| <span id="L73"><span class="lineNum"> 73</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L74"><span class="lineNum"> 74</span> : : </span> |
| <span id="L75"><span class="lineNum"> 75</span> : : /* XXX Add timeout */</span> |
| <span id="L76"><span class="lineNum"> 76</span> :<span class="tlaUNC"> 0 : for (;;) {</span></span> |
| <span id="L77"><span class="lineNum"> 77</span> :<span class="tlaGNC tlaBgGNC"> 16234 : rc = fl_read_stat(ct, &stat);</span></span> |
| <span id="L78"><span class="lineNum"> 78</span> :<span class="tlaGNC"> 16234 : if (rc) return rc;</span></span> |
| <span id="L79"><span class="lineNum"> 79</span> :<span class="tlaGNC"> 16234 : if (!(stat & STAT_WIP)) {</span></span> |
| <span id="L80"><span class="lineNum"> 80</span> :<span class="tlaGNC"> 8117 : if (ct->finfo->flags & FL_MICRON_BUGS)</span></span> |
| <span id="L81"><span class="lineNum"> 81</span> :<span class="tlaUNC tlaBgUNC"> 0 : fl_micron_status(ct);</span></span> |
| <span id="L82"><span class="lineNum"> 82</span> :<span class="tlaGNC tlaBgGNC"> 8117 : return 0;</span></span> |
| <span id="L83"><span class="lineNum"> 83</span> : : }</span> |
| <span id="L84"><span class="lineNum"> 84</span> : : }</span> |
| <span id="L85"><span class="lineNum"> 85</span> : : /* return FLASH_ERR_WIP_TIMEOUT; */</span> |
| <span id="L86"><span class="lineNum"> 86</span> : : }</span> |
| <span id="L87"><span class="lineNum"> 87</span> : : </span> |
| <span id="L88"><span class="lineNum"> 88</span> : : /* Exported for internal use */</span> |
| <span id="L89"><span class="lineNum"> 89</span> :<span class="tlaGNC"> 8118 : int fl_wren(struct spi_flash_ctrl *ct)</span></span> |
| <span id="L90"><span class="lineNum"> 90</span> : : {</span> |
| <span id="L91"><span class="lineNum"> 91</span> :<span class="tlaUNC tlaBgUNC"> 0 : int i, rc;</span></span> |
| <span id="L92"><span class="lineNum"> 92</span> :<span class="tlaUNC"> 0 : uint8_t stat;</span></span> |
| <span id="L93"><span class="lineNum"> 93</span> : : </span> |
| <span id="L94"><span class="lineNum"> 94</span> : : /* Some flashes need it to be hammered */</span> |
| <span id="L95"><span class="lineNum"> 95</span> :<span class="tlaGNC tlaBgGNC"> 8118 : for (i = 0; i < 1000; i++) {</span></span> |
| <span id="L96"><span class="lineNum"> 96</span> :<span class="tlaGNC"> 8118 : rc = ct->cmd_wr(ct, CMD_WREN, false, 0, NULL, 0);</span></span> |
| <span id="L97"><span class="lineNum"> 97</span> :<span class="tlaGNC"> 8118 : if (rc) return rc;</span></span> |
| <span id="L98"><span class="lineNum"> 98</span> :<span class="tlaGNC"> 8118 : rc = fl_read_stat(ct, &stat);</span></span> |
| <span id="L99"><span class="lineNum"> 99</span> :<span class="tlaGNC"> 8118 : if (rc) return rc;</span></span> |
| <span id="L100"><span class="lineNum"> 100</span> :<span class="tlaGNC"> 8118 : if (stat & STAT_WIP) {</span></span> |
| <span id="L101"><span class="lineNum"> 101</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: WREN has WIP status set !\n");</span></span> |
| <span id="L102"><span class="lineNum"> 102</span> :<span class="tlaUNC"> 0 : rc = fl_sync_wait_idle(ct);</span></span> |
| <span id="L103"><span class="lineNum"> 103</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L104"><span class="lineNum"> 104</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L105"><span class="lineNum"> 105</span> :<span class="tlaUNC"> 0 : continue;</span></span> |
| <span id="L106"><span class="lineNum"> 106</span> : : }</span> |
| <span id="L107"><span class="lineNum"> 107</span> :<span class="tlaGNC tlaBgGNC"> 8118 : if (stat & STAT_WEN)</span></span> |
| <span id="L108"><span class="lineNum"> 108</span> :<span class="tlaGNC"> 8118 : return 0;</span></span> |
| <span id="L109"><span class="lineNum"> 109</span> : : }</span> |
| <span id="L110"><span class="lineNum"> 110</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_WREN_TIMEOUT;</span></span> |
| <span id="L111"><span class="lineNum"> 111</span> : : }</span> |
| <span id="L112"><span class="lineNum"> 112</span> : : </span> |
| <span id="L113"><span class="lineNum"> 113</span> :<span class="tlaGNC tlaBgGNC"> 869 : static int flash_read(struct blocklevel_device *bl, uint64_t pos, void *buf, uint64_t len)</span></span> |
| <span id="L114"><span class="lineNum"> 114</span> : : {</span> |
| <span id="L115"><span class="lineNum"> 115</span> :<span class="tlaGNC"> 869 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L116"><span class="lineNum"> 116</span> :<span class="tlaGNC"> 869 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L117"><span class="lineNum"> 117</span> : : </span> |
| <span id="L118"><span class="lineNum"> 118</span> : : /* XXX Add sanity/bound checking */</span> |
| <span id="L119"><span class="lineNum"> 119</span> : : </span> |
| <span id="L120"><span class="lineNum"> 120</span> : : /*</span> |
| <span id="L121"><span class="lineNum"> 121</span> : : * If the controller supports read and either we are in 3b mode</span> |
| <span id="L122"><span class="lineNum"> 122</span> : : * or we are in 4b *and* the controller supports it, then do a</span> |
| <span id="L123"><span class="lineNum"> 123</span> : : * high level read.</span> |
| <span id="L124"><span class="lineNum"> 124</span> : : */</span> |
| <span id="L125"><span class="lineNum"> 125</span> :<span class="tlaGNC"> 869 : if ((!c->mode_4b || ct->set_4b) && ct->read)</span></span> |
| <span id="L126"><span class="lineNum"> 126</span> :<span class="tlaGNC"> 869 : return ct->read(ct, pos, buf, len);</span></span> |
| <span id="L127"><span class="lineNum"> 127</span> : : </span> |
| <span id="L128"><span class="lineNum"> 128</span> : : /* Otherwise, go manual if supported */</span> |
| <span id="L129"><span class="lineNum"> 129</span> :<span class="tlaUNC tlaBgUNC"> 0 : if (!ct->cmd_rd)</span></span> |
| <span id="L130"><span class="lineNum"> 130</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_CTRL_CMD_UNSUPPORTED;</span></span> |
| <span id="L131"><span class="lineNum"> 131</span> :<span class="tlaUNC"> 0 : return ct->cmd_rd(ct, CMD_READ, true, pos, buf, len);</span></span> |
| <span id="L132"><span class="lineNum"> 132</span> : : }</span> |
| <span id="L133"><span class="lineNum"> 133</span> : : </span> |
| <span id="L134"><span class="lineNum"> 134</span> : : #define COPY_BUFFER_LENGTH 4096</span> |
| <span id="L135"><span class="lineNum"> 135</span> : : </span> |
| <span id="L136"><span class="lineNum"> 136</span> : : /*</span> |
| <span id="L137"><span class="lineNum"> 137</span> : : * This provides a wrapper around flash_read on ECCed data</span> |
| <span id="L138"><span class="lineNum"> 138</span> : : * len is length of data without ECC attached</span> |
| <span id="L139"><span class="lineNum"> 139</span> : : */</span> |
| <span id="L140"><span class="lineNum"> 140</span> :<span class="tlaUNC"> 0 : int flash_read_corrected(struct blocklevel_device *bl, uint32_t pos, void *buf,</span></span> |
| <span id="L141"><span class="lineNum"> 141</span> : : uint32_t len, bool ecc)</span> |
| <span id="L142"><span class="lineNum"> 142</span> : : {</span> |
| <span id="L143"><span class="lineNum"> 143</span> :<span class="tlaUNC"> 0 : struct ecc64 *bufecc;</span></span> |
| <span id="L144"><span class="lineNum"> 144</span> :<span class="tlaUNC"> 0 : uint32_t copylen;</span></span> |
| <span id="L145"><span class="lineNum"> 145</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L146"><span class="lineNum"> 146</span> :<span class="tlaUNC"> 0 : uint8_t ret;</span></span> |
| <span id="L147"><span class="lineNum"> 147</span> : : </span> |
| <span id="L148"><span class="lineNum"> 148</span> :<span class="tlaUNC"> 0 : if (!ecc)</span></span> |
| <span id="L149"><span class="lineNum"> 149</span> :<span class="tlaUNC"> 0 : return flash_read(bl, pos, buf, len);</span></span> |
| <span id="L150"><span class="lineNum"> 150</span> : : </span> |
| <span id="L151"><span class="lineNum"> 151</span> : : /* Copy the buffer in chunks */</span> |
| <span id="L152"><span class="lineNum"> 152</span> :<span class="tlaUNC"> 0 : bufecc = malloc(ecc_buffer_size(COPY_BUFFER_LENGTH));</span></span> |
| <span id="L153"><span class="lineNum"> 153</span> :<span class="tlaUNC"> 0 : if (!bufecc)</span></span> |
| <span id="L154"><span class="lineNum"> 154</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L155"><span class="lineNum"> 155</span> : : </span> |
| <span id="L156"><span class="lineNum"> 156</span> :<span class="tlaUNC"> 0 : while (len > 0) {</span></span> |
| <span id="L157"><span class="lineNum"> 157</span> : : /* What's left to copy? */</span> |
| <span id="L158"><span class="lineNum"> 158</span> :<span class="tlaUNC"> 0 : copylen = MIN(len, COPY_BUFFER_LENGTH);</span></span> |
| <span id="L159"><span class="lineNum"> 159</span> : : </span> |
| <span id="L160"><span class="lineNum"> 160</span> : : /* Read ECCed data from flash */</span> |
| <span id="L161"><span class="lineNum"> 161</span> :<span class="tlaUNC"> 0 : rc = flash_read(bl, pos, bufecc, ecc_buffer_size(copylen));</span></span> |
| <span id="L162"><span class="lineNum"> 162</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L163"><span class="lineNum"> 163</span> :<span class="tlaUNC"> 0 : goto err;</span></span> |
| <span id="L164"><span class="lineNum"> 164</span> : : </span> |
| <span id="L165"><span class="lineNum"> 165</span> : : /* Extract data from ECCed data */</span> |
| <span id="L166"><span class="lineNum"> 166</span> :<span class="tlaUNC"> 0 : ret = memcpy_from_ecc(buf, bufecc, copylen);</span></span> |
| <span id="L167"><span class="lineNum"> 167</span> :<span class="tlaUNC"> 0 : if (ret) {</span></span> |
| <span id="L168"><span class="lineNum"> 168</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L169"><span class="lineNum"> 169</span> :<span class="tlaUNC"> 0 : goto err;</span></span> |
| <span id="L170"><span class="lineNum"> 170</span> : : }</span> |
| <span id="L171"><span class="lineNum"> 171</span> : : </span> |
| <span id="L172"><span class="lineNum"> 172</span> : : /* Update for next copy */</span> |
| <span id="L173"><span class="lineNum"> 173</span> :<span class="tlaUNC"> 0 : len -= copylen;</span></span> |
| <span id="L174"><span class="lineNum"> 174</span> :<span class="tlaUNC"> 0 : buf = (uint8_t *)buf + copylen;</span></span> |
| <span id="L175"><span class="lineNum"> 175</span> :<span class="tlaUNC"> 0 : pos += ecc_buffer_size(copylen);</span></span> |
| <span id="L176"><span class="lineNum"> 176</span> : : }</span> |
| <span id="L177"><span class="lineNum"> 177</span> : : </span> |
| <span id="L178"><span class="lineNum"> 178</span> :<span class="tlaUNC"> 0 : rc = 0;</span></span> |
| <span id="L179"><span class="lineNum"> 179</span> : : </span> |
| <span id="L180"><span class="lineNum"> 180</span> :<span class="tlaUNC"> 0 : err:</span></span> |
| <span id="L181"><span class="lineNum"> 181</span> :<span class="tlaUNC"> 0 : free(bufecc);</span></span> |
| <span id="L182"><span class="lineNum"> 182</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L183"><span class="lineNum"> 183</span> : : }</span> |
| <span id="L184"><span class="lineNum"> 184</span> : : </span> |
| <span id="L185"><span class="lineNum"> 185</span> :<span class="tlaGNC tlaBgGNC"> 19 : static void fl_get_best_erase(struct flash_chip *c, uint32_t dst, uint32_t size,</span></span> |
| <span id="L186"><span class="lineNum"> 186</span> : : uint32_t *chunk, uint8_t *cmd)</span> |
| <span id="L187"><span class="lineNum"> 187</span> : : {</span> |
| <span id="L188"><span class="lineNum"> 188</span> : : /* Smaller than 32k, use 4k */</span> |
| <span id="L189"><span class="lineNum"> 189</span> :<span class="tlaGNC"> 19 : if ((dst & 0x7fff) || (size < 0x8000)) {</span></span> |
| <span id="L190"><span class="lineNum"> 190</span> :<span class="tlaGNC"> 18 : *chunk = 0x1000;</span></span> |
| <span id="L191"><span class="lineNum"> 191</span> :<span class="tlaGNC"> 18 : *cmd = CMD_SE;</span></span> |
| <span id="L192"><span class="lineNum"> 192</span> :<span class="tlaGNC"> 18 : return;</span></span> |
| <span id="L193"><span class="lineNum"> 193</span> : : }</span> |
| <span id="L194"><span class="lineNum"> 194</span> : : /* Smaller than 64k and 32k is supported, use it */</span> |
| <span id="L195"><span class="lineNum"> 195</span> :<span class="tlaGNC"> 1 : if ((c->info.flags & FL_ERASE_32K) &&</span></span> |
| <span id="L196"><span class="lineNum"> 196</span> :<span class="tlaGNC"> 1 : ((dst & 0xffff) || (size < 0x10000))) {</span></span> |
| <span id="L197"><span class="lineNum"> 197</span> :<span class="tlaUNC tlaBgUNC"> 0 : *chunk = 0x8000;</span></span> |
| <span id="L198"><span class="lineNum"> 198</span> :<span class="tlaUNC"> 0 : *cmd = CMD_BE32K;</span></span> |
| <span id="L199"><span class="lineNum"> 199</span> :<span class="tlaUNC"> 0 : return;</span></span> |
| <span id="L200"><span class="lineNum"> 200</span> : : }</span> |
| <span id="L201"><span class="lineNum"> 201</span> : : /* If 64K is not supported, use whatever smaller size is */</span> |
| <span id="L202"><span class="lineNum"> 202</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (!(c->info.flags & FL_ERASE_64K)) {</span></span> |
| <span id="L203"><span class="lineNum"> 203</span> :<span class="tlaUNC tlaBgUNC"> 0 : if (c->info.flags & FL_ERASE_32K) {</span></span> |
| <span id="L204"><span class="lineNum"> 204</span> :<span class="tlaUNC"> 0 : *chunk = 0x8000;</span></span> |
| <span id="L205"><span class="lineNum"> 205</span> :<span class="tlaUNC"> 0 : *cmd = CMD_BE32K;</span></span> |
| <span id="L206"><span class="lineNum"> 206</span> : : } else {</span> |
| <span id="L207"><span class="lineNum"> 207</span> :<span class="tlaUNC"> 0 : *chunk = 0x1000;</span></span> |
| <span id="L208"><span class="lineNum"> 208</span> :<span class="tlaUNC"> 0 : *cmd = CMD_SE;</span></span> |
| <span id="L209"><span class="lineNum"> 209</span> : : }</span> |
| <span id="L210"><span class="lineNum"> 210</span> :<span class="tlaUNC"> 0 : return;</span></span> |
| <span id="L211"><span class="lineNum"> 211</span> : : }</span> |
| <span id="L212"><span class="lineNum"> 212</span> : : /* Allright, let's go for 64K */</span> |
| <span id="L213"><span class="lineNum"> 213</span> :<span class="tlaGNC tlaBgGNC"> 1 : *chunk = 0x10000;</span></span> |
| <span id="L214"><span class="lineNum"> 214</span> :<span class="tlaGNC"> 1 : *cmd = CMD_BE;</span></span> |
| <span id="L215"><span class="lineNum"> 215</span> : : }</span> |
| <span id="L216"><span class="lineNum"> 216</span> : : </span> |
| <span id="L217"><span class="lineNum"> 217</span> :<span class="tlaGNC"> 19 : static int flash_erase(struct blocklevel_device *bl, uint64_t dst, uint64_t size)</span></span> |
| <span id="L218"><span class="lineNum"> 218</span> : : {</span> |
| <span id="L219"><span class="lineNum"> 219</span> :<span class="tlaGNC"> 19 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L220"><span class="lineNum"> 220</span> :<span class="tlaGNC"> 19 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L221"><span class="lineNum"> 221</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint32_t chunk;</span></span> |
| <span id="L222"><span class="lineNum"> 222</span> :<span class="tlaUNC"> 0 : uint8_t cmd;</span></span> |
| <span id="L223"><span class="lineNum"> 223</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L224"><span class="lineNum"> 224</span> : : </span> |
| <span id="L225"><span class="lineNum"> 225</span> : : /* Some sanity checking */</span> |
| <span id="L226"><span class="lineNum"> 226</span> :<span class="tlaGNC tlaBgGNC"> 19 : if (((dst + size) <= dst) || !size || (dst + size) > c->tsize)</span></span> |
| <span id="L227"><span class="lineNum"> 227</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L228"><span class="lineNum"> 228</span> : : </span> |
| <span id="L229"><span class="lineNum"> 229</span> : : /* Check boundaries fit erase blocks */</span> |
| <span id="L230"><span class="lineNum"> 230</span> :<span class="tlaGNC tlaBgGNC"> 19 : if ((dst | size) & c->min_erase_mask)</span></span> |
| <span id="L231"><span class="lineNum"> 231</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_ERASE_BOUNDARY;</span></span> |
| <span id="L232"><span class="lineNum"> 232</span> : : </span> |
| <span id="L233"><span class="lineNum"> 233</span> :<span class="tlaGNC tlaBgGNC"> 19 : FL_DBG("LIBFLASH: Erasing 0x%" PRIx64"..0%" PRIx64 "...\n",</span></span> |
| <span id="L234"><span class="lineNum"> 234</span> : : dst, dst + size);</span> |
| <span id="L235"><span class="lineNum"> 235</span> : : </span> |
| <span id="L236"><span class="lineNum"> 236</span> : : /* Use controller erase if supported */</span> |
| <span id="L237"><span class="lineNum"> 237</span> :<span class="tlaGNC"> 19 : if (ct->erase)</span></span> |
| <span id="L238"><span class="lineNum"> 238</span> :<span class="tlaUNC tlaBgUNC"> 0 : return ct->erase(ct, dst, size);</span></span> |
| <span id="L239"><span class="lineNum"> 239</span> : : </span> |
| <span id="L240"><span class="lineNum"> 240</span> : : /* Allright, loop as long as there's something to erase */</span> |
| <span id="L241"><span class="lineNum"> 241</span> :<span class="tlaGNC tlaBgGNC"> 38 : while(size) {</span></span> |
| <span id="L242"><span class="lineNum"> 242</span> : : /* How big can we make it based on alignent & size */</span> |
| <span id="L243"><span class="lineNum"> 243</span> :<span class="tlaGNC"> 19 : fl_get_best_erase(c, dst, size, &chunk, &cmd);</span></span> |
| <span id="L244"><span class="lineNum"> 244</span> : : </span> |
| <span id="L245"><span class="lineNum"> 245</span> : : /* Poke write enable */</span> |
| <span id="L246"><span class="lineNum"> 246</span> :<span class="tlaGNC"> 19 : rc = fl_wren(ct);</span></span> |
| <span id="L247"><span class="lineNum"> 247</span> :<span class="tlaGNC"> 19 : if (rc)</span></span> |
| <span id="L248"><span class="lineNum"> 248</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L249"><span class="lineNum"> 249</span> : : </span> |
| <span id="L250"><span class="lineNum"> 250</span> : : /* Send erase command */</span> |
| <span id="L251"><span class="lineNum"> 251</span> :<span class="tlaGNC tlaBgGNC"> 19 : rc = ct->cmd_wr(ct, cmd, true, dst, NULL, 0);</span></span> |
| <span id="L252"><span class="lineNum"> 252</span> :<span class="tlaGNC"> 19 : if (rc)</span></span> |
| <span id="L253"><span class="lineNum"> 253</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L254"><span class="lineNum"> 254</span> : : </span> |
| <span id="L255"><span class="lineNum"> 255</span> : : /* Wait for write complete */</span> |
| <span id="L256"><span class="lineNum"> 256</span> :<span class="tlaGNC tlaBgGNC"> 19 : rc = fl_sync_wait_idle(ct);</span></span> |
| <span id="L257"><span class="lineNum"> 257</span> :<span class="tlaGNC"> 19 : if (rc)</span></span> |
| <span id="L258"><span class="lineNum"> 258</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L259"><span class="lineNum"> 259</span> : : </span> |
| <span id="L260"><span class="lineNum"> 260</span> :<span class="tlaGNC tlaBgGNC"> 19 : size -= chunk;</span></span> |
| <span id="L261"><span class="lineNum"> 261</span> :<span class="tlaGNC"> 19 : dst += chunk;</span></span> |
| <span id="L262"><span class="lineNum"> 262</span> : : }</span> |
| <span id="L263"><span class="lineNum"> 263</span> :<span class="tlaGNC"> 19 : return 0;</span></span> |
| <span id="L264"><span class="lineNum"> 264</span> : : }</span> |
| <span id="L265"><span class="lineNum"> 265</span> : : </span> |
| <span id="L266"><span class="lineNum"> 266</span> :<span class="tlaUNC tlaBgUNC"> 0 : int flash_erase_chip(struct flash_chip *c)</span></span> |
| <span id="L267"><span class="lineNum"> 267</span> : : {</span> |
| <span id="L268"><span class="lineNum"> 268</span> :<span class="tlaUNC"> 0 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L269"><span class="lineNum"> 269</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L270"><span class="lineNum"> 270</span> : : </span> |
| <span id="L271"><span class="lineNum"> 271</span> : : /* XXX TODO: Fallback to using normal erases */</span> |
| <span id="L272"><span class="lineNum"> 272</span> :<span class="tlaUNC"> 0 : if (!(c->info.flags & (FL_ERASE_CHIP|FL_ERASE_BULK)))</span></span> |
| <span id="L273"><span class="lineNum"> 273</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_CHIP_ER_NOT_SUPPORTED;</span></span> |
| <span id="L274"><span class="lineNum"> 274</span> : : </span> |
| <span id="L275"><span class="lineNum"> 275</span> :<span class="tlaUNC"> 0 : FL_DBG("LIBFLASH: Erasing chip...\n");</span></span> |
| <span id="L276"><span class="lineNum"> 276</span> : : </span> |
| <span id="L277"><span class="lineNum"> 277</span> : : /* Use controller erase if supported */</span> |
| <span id="L278"><span class="lineNum"> 278</span> :<span class="tlaUNC"> 0 : if (ct->erase)</span></span> |
| <span id="L279"><span class="lineNum"> 279</span> :<span class="tlaUNC"> 0 : return ct->erase(ct, 0, 0xffffffff);</span></span> |
| <span id="L280"><span class="lineNum"> 280</span> : : </span> |
| <span id="L281"><span class="lineNum"> 281</span> :<span class="tlaUNC"> 0 : rc = fl_wren(ct);</span></span> |
| <span id="L282"><span class="lineNum"> 282</span> :<span class="tlaUNC"> 0 : if (rc) return rc;</span></span> |
| <span id="L283"><span class="lineNum"> 283</span> : : </span> |
| <span id="L284"><span class="lineNum"> 284</span> :<span class="tlaUNC"> 0 : if (c->info.flags & FL_ERASE_CHIP)</span></span> |
| <span id="L285"><span class="lineNum"> 285</span> :<span class="tlaUNC"> 0 : rc = ct->cmd_wr(ct, CMD_CE, false, 0, NULL, 0);</span></span> |
| <span id="L286"><span class="lineNum"> 286</span> : : else</span> |
| <span id="L287"><span class="lineNum"> 287</span> :<span class="tlaUNC"> 0 : rc = ct->cmd_wr(ct, CMD_MIC_BULK_ERASE, false, 0, NULL, 0);</span></span> |
| <span id="L288"><span class="lineNum"> 288</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L289"><span class="lineNum"> 289</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L290"><span class="lineNum"> 290</span> : : </span> |
| <span id="L291"><span class="lineNum"> 291</span> : : /* Wait for write complete */</span> |
| <span id="L292"><span class="lineNum"> 292</span> :<span class="tlaUNC"> 0 : return fl_sync_wait_idle(ct);</span></span> |
| <span id="L293"><span class="lineNum"> 293</span> : : }</span> |
| <span id="L294"><span class="lineNum"> 294</span> : : </span> |
| <span id="L295"><span class="lineNum"> 295</span> :<span class="tlaGNC tlaBgGNC"> 8098 : static int fl_wpage(struct flash_chip *c, uint32_t dst, const void *src,</span></span> |
| <span id="L296"><span class="lineNum"> 296</span> : : uint32_t size)</span> |
| <span id="L297"><span class="lineNum"> 297</span> : : {</span> |
| <span id="L298"><span class="lineNum"> 298</span> :<span class="tlaGNC"> 8098 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L299"><span class="lineNum"> 299</span> :<span class="tlaUNC tlaBgUNC"> 0 : int rc;</span></span> |
| <span id="L300"><span class="lineNum"> 300</span> : : </span> |
| <span id="L301"><span class="lineNum"> 301</span> :<span class="tlaGNC tlaBgGNC"> 8098 : if (size < 1 || size > 0x100)</span></span> |
| <span id="L302"><span class="lineNum"> 302</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_BAD_PAGE_SIZE;</span></span> |
| <span id="L303"><span class="lineNum"> 303</span> : : </span> |
| <span id="L304"><span class="lineNum"> 304</span> :<span class="tlaGNC tlaBgGNC"> 8098 : rc = fl_wren(ct);</span></span> |
| <span id="L305"><span class="lineNum"> 305</span> :<span class="tlaGNC"> 8098 : if (rc) return rc;</span></span> |
| <span id="L306"><span class="lineNum"> 306</span> : : </span> |
| <span id="L307"><span class="lineNum"> 307</span> :<span class="tlaGNC"> 8098 : rc = ct->cmd_wr(ct, CMD_PP, true, dst, src, size);</span></span> |
| <span id="L308"><span class="lineNum"> 308</span> :<span class="tlaGNC"> 8098 : if (rc)</span></span> |
| <span id="L309"><span class="lineNum"> 309</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L310"><span class="lineNum"> 310</span> : : </span> |
| <span id="L311"><span class="lineNum"> 311</span> : : /* Wait for write complete */</span> |
| <span id="L312"><span class="lineNum"> 312</span> :<span class="tlaGNC tlaBgGNC"> 8098 : return fl_sync_wait_idle(ct);</span></span> |
| <span id="L313"><span class="lineNum"> 313</span> : : }</span> |
| <span id="L314"><span class="lineNum"> 314</span> : : </span> |
| <span id="L315"><span class="lineNum"> 315</span> :<span class="tlaGNC"> 7333 : static int flash_write(struct blocklevel_device *bl, uint32_t dst, const void *src,</span></span> |
| <span id="L316"><span class="lineNum"> 316</span> : : uint32_t size, bool verify)</span> |
| <span id="L317"><span class="lineNum"> 317</span> : : {</span> |
| <span id="L318"><span class="lineNum"> 318</span> :<span class="tlaGNC"> 7333 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L319"><span class="lineNum"> 319</span> :<span class="tlaGNC"> 7333 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L320"><span class="lineNum"> 320</span> :<span class="tlaGNC"> 7333 : uint32_t todo = size;</span></span> |
| <span id="L321"><span class="lineNum"> 321</span> :<span class="tlaGNC"> 7333 : uint32_t d = dst;</span></span> |
| <span id="L322"><span class="lineNum"> 322</span> :<span class="tlaGNC"> 7333 : const void *s = src;</span></span> |
| <span id="L323"><span class="lineNum"> 323</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint8_t vbuf[0x100];</span></span> |
| <span id="L324"><span class="lineNum"> 324</span> :<span class="tlaUNC"> 0 : int rc; </span></span> |
| <span id="L325"><span class="lineNum"> 325</span> : : </span> |
| <span id="L326"><span class="lineNum"> 326</span> : : /* Some sanity checking */</span> |
| <span id="L327"><span class="lineNum"> 327</span> :<span class="tlaGNC tlaBgGNC"> 7333 : if (((dst + size) <= dst) || !size || (dst + size) > c->tsize)</span></span> |
| <span id="L328"><span class="lineNum"> 328</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L329"><span class="lineNum"> 329</span> : : </span> |
| <span id="L330"><span class="lineNum"> 330</span> :<span class="tlaGNC tlaBgGNC"> 7333 : FL_DBG("LIBFLASH: Writing to 0x%08x..0%08x...\n", dst, dst + size);</span></span> |
| <span id="L331"><span class="lineNum"> 331</span> : : </span> |
| <span id="L332"><span class="lineNum"> 332</span> : : /*</span> |
| <span id="L333"><span class="lineNum"> 333</span> : : * If the controller supports write and either we are in 3b mode</span> |
| <span id="L334"><span class="lineNum"> 334</span> : : * or we are in 4b *and* the controller supports it, then do a</span> |
| <span id="L335"><span class="lineNum"> 335</span> : : * high level write.</span> |
| <span id="L336"><span class="lineNum"> 336</span> : : */</span> |
| <span id="L337"><span class="lineNum"> 337</span> :<span class="tlaGNC"> 7333 : if ((!c->mode_4b || ct->set_4b) && ct->write) {</span></span> |
| <span id="L338"><span class="lineNum"> 338</span> :<span class="tlaUNC tlaBgUNC"> 0 : rc = ct->write(ct, dst, src, size);</span></span> |
| <span id="L339"><span class="lineNum"> 339</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L340"><span class="lineNum"> 340</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L341"><span class="lineNum"> 341</span> :<span class="tlaUNC"> 0 : goto writing_done;</span></span> |
| <span id="L342"><span class="lineNum"> 342</span> : : }</span> |
| <span id="L343"><span class="lineNum"> 343</span> : : </span> |
| <span id="L344"><span class="lineNum"> 344</span> : : /* Otherwise, go manual if supported */</span> |
| <span id="L345"><span class="lineNum"> 345</span> :<span class="tlaGNC tlaBgGNC"> 7333 : if (!ct->cmd_wr)</span></span> |
| <span id="L346"><span class="lineNum"> 346</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_CTRL_CMD_UNSUPPORTED;</span></span> |
| <span id="L347"><span class="lineNum"> 347</span> : : </span> |
| <span id="L348"><span class="lineNum"> 348</span> : : /* Iterate for each page to write */</span> |
| <span id="L349"><span class="lineNum"> 349</span> :<span class="tlaGNC tlaBgGNC"> 15431 : while(todo) {</span></span> |
| <span id="L350"><span class="lineNum"> 350</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint32_t chunk;</span></span> |
| <span id="L351"><span class="lineNum"> 351</span> : : </span> |
| <span id="L352"><span class="lineNum"> 352</span> : : /* Handle misaligned start */</span> |
| <span id="L353"><span class="lineNum"> 353</span> :<span class="tlaGNC tlaBgGNC"> 8098 : chunk = 0x100 - (d & 0xff);</span></span> |
| <span id="L354"><span class="lineNum"> 354</span> :<span class="tlaGNC"> 8098 : if (chunk > todo)</span></span> |
| <span id="L355"><span class="lineNum"> 355</span> :<span class="tlaGNC"> 7254 : chunk = todo;</span></span> |
| <span id="L356"><span class="lineNum"> 356</span> : : </span> |
| <span id="L357"><span class="lineNum"> 357</span> :<span class="tlaGNC"> 8098 : rc = fl_wpage(c, d, s, chunk);</span></span> |
| <span id="L358"><span class="lineNum"> 358</span> :<span class="tlaGNC"> 8098 : if (rc) return rc;</span></span> |
| <span id="L359"><span class="lineNum"> 359</span> :<span class="tlaGNC"> 8098 : d += chunk;</span></span> |
| <span id="L360"><span class="lineNum"> 360</span> :<span class="tlaGNC"> 8098 : s += chunk;</span></span> |
| <span id="L361"><span class="lineNum"> 361</span> :<span class="tlaGNC"> 8098 : todo -= chunk;</span></span> |
| <span id="L362"><span class="lineNum"> 362</span> : : }</span> |
| <span id="L363"><span class="lineNum"> 363</span> : : </span> |
| <span id="L364"><span class="lineNum"> 364</span> :<span class="tlaGNC"> 7333 : writing_done:</span></span> |
| <span id="L365"><span class="lineNum"> 365</span> :<span class="tlaGNC"> 7333 : if (!verify)</span></span> |
| <span id="L366"><span class="lineNum"> 366</span> :<span class="tlaGNC"> 7281 : return 0;</span></span> |
| <span id="L367"><span class="lineNum"> 367</span> : : </span> |
| <span id="L368"><span class="lineNum"> 368</span> : : /* Verify */</span> |
| <span id="L369"><span class="lineNum"> 369</span> :<span class="tlaGNC"> 52 : FL_DBG("LIBFLASH: Verifying...\n");</span></span> |
| <span id="L370"><span class="lineNum"> 370</span> : : </span> |
| <span id="L371"><span class="lineNum"> 371</span> :<span class="tlaGNC"> 869 : while(size) {</span></span> |
| <span id="L372"><span class="lineNum"> 372</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint32_t chunk;</span></span> |
| <span id="L373"><span class="lineNum"> 373</span> : : </span> |
| <span id="L374"><span class="lineNum"> 374</span> :<span class="tlaGNC tlaBgGNC"> 817 : chunk = sizeof(vbuf);</span></span> |
| <span id="L375"><span class="lineNum"> 375</span> :<span class="tlaGNC"> 817 : if (chunk > size)</span></span> |
| <span id="L376"><span class="lineNum"> 376</span> :<span class="tlaGNC"> 1 : chunk = size;</span></span> |
| <span id="L377"><span class="lineNum"> 377</span> :<span class="tlaGNC"> 817 : rc = flash_read(bl, dst, vbuf, chunk);</span></span> |
| <span id="L378"><span class="lineNum"> 378</span> :<span class="tlaGNC"> 817 : if (rc) return rc;</span></span> |
| <span id="L379"><span class="lineNum"> 379</span> :<span class="tlaGNC"> 817 : if (memcmp(vbuf, src, chunk)) {</span></span> |
| <span id="L380"><span class="lineNum"> 380</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Miscompare at 0x%08x\n", dst);</span></span> |
| <span id="L381"><span class="lineNum"> 381</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_VERIFY_FAILURE;</span></span> |
| <span id="L382"><span class="lineNum"> 382</span> : : }</span> |
| <span id="L383"><span class="lineNum"> 383</span> :<span class="tlaGNC tlaBgGNC"> 817 : dst += chunk;</span></span> |
| <span id="L384"><span class="lineNum"> 384</span> :<span class="tlaGNC"> 817 : src += chunk;</span></span> |
| <span id="L385"><span class="lineNum"> 385</span> :<span class="tlaGNC"> 817 : size -= chunk;</span></span> |
| <span id="L386"><span class="lineNum"> 386</span> : : }</span> |
| <span id="L387"><span class="lineNum"> 387</span> :<span class="tlaGNC"> 52 : return 0;</span></span> |
| <span id="L388"><span class="lineNum"> 388</span> : : }</span> |
| <span id="L389"><span class="lineNum"> 389</span> : : </span> |
| <span id="L390"><span class="lineNum"> 390</span> :<span class="tlaUNC tlaBgUNC"> 0 : int flash_write_corrected(struct blocklevel_device *bl, uint32_t pos, const void *buf,</span></span> |
| <span id="L391"><span class="lineNum"> 391</span> : : uint32_t len, bool verify, bool ecc)</span> |
| <span id="L392"><span class="lineNum"> 392</span> : : {</span> |
| <span id="L393"><span class="lineNum"> 393</span> :<span class="tlaUNC"> 0 : struct ecc64 *bufecc;</span></span> |
| <span id="L394"><span class="lineNum"> 394</span> :<span class="tlaUNC"> 0 : uint32_t copylen, copylen_minus_ecc;</span></span> |
| <span id="L395"><span class="lineNum"> 395</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L396"><span class="lineNum"> 396</span> :<span class="tlaUNC"> 0 : uint8_t ret;</span></span> |
| <span id="L397"><span class="lineNum"> 397</span> : : </span> |
| <span id="L398"><span class="lineNum"> 398</span> :<span class="tlaUNC"> 0 : if (!ecc)</span></span> |
| <span id="L399"><span class="lineNum"> 399</span> :<span class="tlaUNC"> 0 : return flash_write(bl, pos, buf, len, verify);</span></span> |
| <span id="L400"><span class="lineNum"> 400</span> : : </span> |
| <span id="L401"><span class="lineNum"> 401</span> : : /* Copy the buffer in chunks */</span> |
| <span id="L402"><span class="lineNum"> 402</span> :<span class="tlaUNC"> 0 : bufecc = malloc(ecc_buffer_size(COPY_BUFFER_LENGTH));</span></span> |
| <span id="L403"><span class="lineNum"> 403</span> :<span class="tlaUNC"> 0 : if (!bufecc)</span></span> |
| <span id="L404"><span class="lineNum"> 404</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L405"><span class="lineNum"> 405</span> : : </span> |
| <span id="L406"><span class="lineNum"> 406</span> :<span class="tlaUNC"> 0 : while (len > 0) {</span></span> |
| <span id="L407"><span class="lineNum"> 407</span> : : /* What's left to copy? */</span> |
| <span id="L408"><span class="lineNum"> 408</span> :<span class="tlaUNC"> 0 : copylen = MIN(len, COPY_BUFFER_LENGTH);</span></span> |
| <span id="L409"><span class="lineNum"> 409</span> :<span class="tlaUNC"> 0 : copylen_minus_ecc = ecc_buffer_size_minus_ecc(copylen);</span></span> |
| <span id="L410"><span class="lineNum"> 410</span> : : </span> |
| <span id="L411"><span class="lineNum"> 411</span> : : /* Add the ecc byte to the data */</span> |
| <span id="L412"><span class="lineNum"> 412</span> :<span class="tlaUNC"> 0 : ret = memcpy_to_ecc(bufecc, buf, copylen_minus_ecc);</span></span> |
| <span id="L413"><span class="lineNum"> 413</span> :<span class="tlaUNC"> 0 : if (ret) {</span></span> |
| <span id="L414"><span class="lineNum"> 414</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L415"><span class="lineNum"> 415</span> :<span class="tlaUNC"> 0 : goto err;</span></span> |
| <span id="L416"><span class="lineNum"> 416</span> : : }</span> |
| <span id="L417"><span class="lineNum"> 417</span> : : </span> |
| <span id="L418"><span class="lineNum"> 418</span> : : /* Write ECCed data to the flash */</span> |
| <span id="L419"><span class="lineNum"> 419</span> :<span class="tlaUNC"> 0 : rc = flash_write(bl, pos, bufecc, copylen, verify);</span></span> |
| <span id="L420"><span class="lineNum"> 420</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L421"><span class="lineNum"> 421</span> :<span class="tlaUNC"> 0 : goto err;</span></span> |
| <span id="L422"><span class="lineNum"> 422</span> : : </span> |
| <span id="L423"><span class="lineNum"> 423</span> : : /* Update for next copy */</span> |
| <span id="L424"><span class="lineNum"> 424</span> :<span class="tlaUNC"> 0 : len -= copylen_minus_ecc;</span></span> |
| <span id="L425"><span class="lineNum"> 425</span> :<span class="tlaUNC"> 0 : buf = (uint8_t *)buf + copylen_minus_ecc;</span></span> |
| <span id="L426"><span class="lineNum"> 426</span> :<span class="tlaUNC"> 0 : pos += copylen;</span></span> |
| <span id="L427"><span class="lineNum"> 427</span> : : }</span> |
| <span id="L428"><span class="lineNum"> 428</span> : : </span> |
| <span id="L429"><span class="lineNum"> 429</span> :<span class="tlaUNC"> 0 : rc = 0;</span></span> |
| <span id="L430"><span class="lineNum"> 430</span> : : </span> |
| <span id="L431"><span class="lineNum"> 431</span> :<span class="tlaUNC"> 0 : err:</span></span> |
| <span id="L432"><span class="lineNum"> 432</span> :<span class="tlaUNC"> 0 : free(bufecc);</span></span> |
| <span id="L433"><span class="lineNum"> 433</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L434"><span class="lineNum"> 434</span> : : }</span> |
| <span id="L435"><span class="lineNum"> 435</span> : : </span> |
| <span id="L436"><span class="lineNum"> 436</span> : : enum sm_comp_res {</span> |
| <span id="L437"><span class="lineNum"> 437</span> : : sm_no_change,</span> |
| <span id="L438"><span class="lineNum"> 438</span> : : sm_need_write,</span> |
| <span id="L439"><span class="lineNum"> 439</span> : : sm_need_erase,</span> |
| <span id="L440"><span class="lineNum"> 440</span> : : };</span> |
| <span id="L441"><span class="lineNum"> 441</span> : : </span> |
| <span id="L442"><span class="lineNum"> 442</span> :<span class="tlaGNC tlaBgGNC"> 52 : static enum sm_comp_res flash_smart_comp(struct flash_chip *c,</span></span> |
| <span id="L443"><span class="lineNum"> 443</span> : : const void *src,</span> |
| <span id="L444"><span class="lineNum"> 444</span> : : uint32_t offset, uint32_t size)</span> |
| <span id="L445"><span class="lineNum"> 445</span> : : {</span> |
| <span id="L446"><span class="lineNum"> 446</span> :<span class="tlaGNC"> 52 : uint8_t *b = c->smart_buf + offset;</span></span> |
| <span id="L447"><span class="lineNum"> 447</span> :<span class="tlaGNC"> 52 : const uint8_t *s = src;</span></span> |
| <span id="L448"><span class="lineNum"> 448</span> :<span class="tlaGNC"> 52 : bool is_same = true;</span></span> |
| <span id="L449"><span class="lineNum"> 449</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint32_t i;</span></span> |
| <span id="L450"><span class="lineNum"> 450</span> : : </span> |
| <span id="L451"><span class="lineNum"> 451</span> : : /* SRC DEST NEED_ERASE</span> |
| <span id="L452"><span class="lineNum"> 452</span> : : * 0 1 0</span> |
| <span id="L453"><span class="lineNum"> 453</span> : : * 1 1 0</span> |
| <span id="L454"><span class="lineNum"> 454</span> : : * 0 0 0</span> |
| <span id="L455"><span class="lineNum"> 455</span> : : * 1 0 1</span> |
| <span id="L456"><span class="lineNum"> 456</span> : : */</span> |
| <span id="L457"><span class="lineNum"> 457</span> :<span class="tlaGNC tlaBgGNC"> 135245 : for (i = 0; i < size; i++) {</span></span> |
| <span id="L458"><span class="lineNum"> 458</span> : : /* Any bit need to be set, need erase */</span> |
| <span id="L459"><span class="lineNum"> 459</span> :<span class="tlaGNC"> 135211 : if (s[i] & ~b[i])</span></span> |
| <span id="L460"><span class="lineNum"> 460</span> :<span class="tlaGNC"> 18 : return sm_need_erase;</span></span> |
| <span id="L461"><span class="lineNum"> 461</span> :<span class="tlaGNC"> 135193 : if (is_same && (b[i] != s[i]))</span></span> |
| <span id="L462"><span class="lineNum"> 462</span> :<span class="tlaGNC"> 36 : is_same = false;</span></span> |
| <span id="L463"><span class="lineNum"> 463</span> : : }</span> |
| <span id="L464"><span class="lineNum"> 464</span> :<span class="tlaGNC"> 34 : return is_same ? sm_no_change : sm_need_write;</span></span> |
| <span id="L465"><span class="lineNum"> 465</span> : : }</span> |
| <span id="L466"><span class="lineNum"> 466</span> : : </span> |
| <span id="L467"><span class="lineNum"> 467</span> :<span class="tlaGNC"> 4 : static int flash_smart_write(struct blocklevel_device *bl, uint64_t dst, const void *src, uint64_t size)</span></span> |
| <span id="L468"><span class="lineNum"> 468</span> : : {</span> |
| <span id="L469"><span class="lineNum"> 469</span> :<span class="tlaGNC"> 4 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L470"><span class="lineNum"> 470</span> :<span class="tlaGNC"> 4 : uint32_t er_size = c->min_erase_mask + 1;</span></span> |
| <span id="L471"><span class="lineNum"> 471</span> :<span class="tlaGNC"> 4 : uint32_t end = dst + size;</span></span> |
| <span id="L472"><span class="lineNum"> 472</span> :<span class="tlaUNC tlaBgUNC"> 0 : int rc;</span></span> |
| <span id="L473"><span class="lineNum"> 473</span> : : </span> |
| <span id="L474"><span class="lineNum"> 474</span> : : /* Some sanity checking */</span> |
| <span id="L475"><span class="lineNum"> 475</span> :<span class="tlaGNC tlaBgGNC"> 4 : if (end <= dst || !size || end > c->tsize) {</span></span> |
| <span id="L476"><span class="lineNum"> 476</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("LIBFLASH: Smart write param error\n");</span></span> |
| <span id="L477"><span class="lineNum"> 477</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L478"><span class="lineNum"> 478</span> : : }</span> |
| <span id="L479"><span class="lineNum"> 479</span> : : </span> |
| <span id="L480"><span class="lineNum"> 480</span> :<span class="tlaGNC tlaBgGNC"> 4 : FL_DBG("LIBFLASH: Smart writing to 0x%" PRIx64 "..0%" PRIx64 "...\n",</span></span> |
| <span id="L481"><span class="lineNum"> 481</span> : : dst, dst + size);</span> |
| <span id="L482"><span class="lineNum"> 482</span> : : </span> |
| <span id="L483"><span class="lineNum"> 483</span> : : /* As long as we have something to write ... */</span> |
| <span id="L484"><span class="lineNum"> 484</span> :<span class="tlaGNC"> 56 : while(dst < end) {</span></span> |
| <span id="L485"><span class="lineNum"> 485</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint32_t page, off, chunk;</span></span> |
| <span id="L486"><span class="lineNum"> 486</span> :<span class="tlaUNC"> 0 : enum sm_comp_res sr;</span></span> |
| <span id="L487"><span class="lineNum"> 487</span> : : </span> |
| <span id="L488"><span class="lineNum"> 488</span> : : /* Figure out which erase page we are in and read it */</span> |
| <span id="L489"><span class="lineNum"> 489</span> :<span class="tlaGNC tlaBgGNC"> 52 : page = dst & ~c->min_erase_mask;</span></span> |
| <span id="L490"><span class="lineNum"> 490</span> :<span class="tlaGNC"> 52 : off = dst & c->min_erase_mask;</span></span> |
| <span id="L491"><span class="lineNum"> 491</span> :<span class="tlaGNC"> 52 : FL_DBG("LIBFLASH: reading page 0x%08x..0x%08x...\n",</span></span> |
| <span id="L492"><span class="lineNum"> 492</span> : : page, page + er_size);</span> |
| <span id="L493"><span class="lineNum"> 493</span> :<span class="tlaGNC"> 52 : rc = flash_read(bl, page, c->smart_buf, er_size);</span></span> |
| <span id="L494"><span class="lineNum"> 494</span> :<span class="tlaGNC"> 52 : if (rc) {</span></span> |
| <span id="L495"><span class="lineNum"> 495</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("LIBFLASH: ...error %d!\n", rc);</span></span> |
| <span id="L496"><span class="lineNum"> 496</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L497"><span class="lineNum"> 497</span> : : }</span> |
| <span id="L498"><span class="lineNum"> 498</span> : : </span> |
| <span id="L499"><span class="lineNum"> 499</span> : : /* Locate the chunk of data we are working on */</span> |
| <span id="L500"><span class="lineNum"> 500</span> :<span class="tlaGNC tlaBgGNC"> 52 : chunk = er_size - off;</span></span> |
| <span id="L501"><span class="lineNum"> 501</span> :<span class="tlaGNC"> 52 : if (size < chunk)</span></span> |
| <span id="L502"><span class="lineNum"> 502</span> :<span class="tlaGNC"> 1 : chunk = size;</span></span> |
| <span id="L503"><span class="lineNum"> 503</span> : : </span> |
| <span id="L504"><span class="lineNum"> 504</span> : : /* Compare against what we are writing and ff */</span> |
| <span id="L505"><span class="lineNum"> 505</span> :<span class="tlaGNC"> 52 : sr = flash_smart_comp(c, src, off, chunk);</span></span> |
| <span id="L506"><span class="lineNum"> 506</span> :<span class="tlaGNC"> 52 : switch(sr) {</span></span> |
| <span id="L507"><span class="lineNum"> 507</span> :<span class="tlaUNC tlaBgUNC"> 0 : case sm_no_change:</span></span> |
| <span id="L508"><span class="lineNum"> 508</span> : : /* Identical, skip it */</span> |
| <span id="L509"><span class="lineNum"> 509</span> :<span class="tlaUNC"> 0 : FL_DBG("LIBFLASH: ...same !\n");</span></span> |
| <span id="L510"><span class="lineNum"> 510</span> :<span class="tlaUNC"> 0 : break;</span></span> |
| <span id="L511"><span class="lineNum"> 511</span> :<span class="tlaGNC tlaBgGNC"> 34 : case sm_need_write:</span></span> |
| <span id="L512"><span class="lineNum"> 512</span> : : /* Just needs writing over */</span> |
| <span id="L513"><span class="lineNum"> 513</span> :<span class="tlaGNC"> 34 : FL_DBG("LIBFLASH: ...need write !\n");</span></span> |
| <span id="L514"><span class="lineNum"> 514</span> :<span class="tlaGNC"> 34 : rc = flash_write(bl, dst, src, chunk, true);</span></span> |
| <span id="L515"><span class="lineNum"> 515</span> :<span class="tlaGNC"> 34 : if (rc) {</span></span> |
| <span id="L516"><span class="lineNum"> 516</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("LIBFLASH: Write error %d !\n", rc);</span></span> |
| <span id="L517"><span class="lineNum"> 517</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L518"><span class="lineNum"> 518</span> : : }</span> |
| <span id="L519"><span class="lineNum"> 519</span> :<span class="tlaGNC tlaBgGNC"> 34 : break;</span></span> |
| <span id="L520"><span class="lineNum"> 520</span> :<span class="tlaGNC"> 18 : case sm_need_erase:</span></span> |
| <span id="L521"><span class="lineNum"> 521</span> :<span class="tlaGNC"> 18 : FL_DBG("LIBFLASH: ...need erase !\n");</span></span> |
| <span id="L522"><span class="lineNum"> 522</span> :<span class="tlaGNC"> 18 : rc = flash_erase(bl, page, er_size);</span></span> |
| <span id="L523"><span class="lineNum"> 523</span> :<span class="tlaGNC"> 18 : if (rc) {</span></span> |
| <span id="L524"><span class="lineNum"> 524</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("LIBFLASH: erase error %d !\n", rc);</span></span> |
| <span id="L525"><span class="lineNum"> 525</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L526"><span class="lineNum"> 526</span> : : }</span> |
| <span id="L527"><span class="lineNum"> 527</span> : : /* Then update the portion of the buffer and write the block */</span> |
| <span id="L528"><span class="lineNum"> 528</span> :<span class="tlaGNC tlaBgGNC"> 18 : memcpy(c->smart_buf + off, src, chunk);</span></span> |
| <span id="L529"><span class="lineNum"> 529</span> :<span class="tlaGNC"> 18 : rc = flash_write(bl, page, c->smart_buf, er_size, true);</span></span> |
| <span id="L530"><span class="lineNum"> 530</span> :<span class="tlaGNC"> 18 : if (rc) {</span></span> |
| <span id="L531"><span class="lineNum"> 531</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("LIBFLASH: write error %d !\n", rc);</span></span> |
| <span id="L532"><span class="lineNum"> 532</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L533"><span class="lineNum"> 533</span> : : }</span> |
| <span id="L534"><span class="lineNum"> 534</span> :<span class="tlaGNC tlaBgGNC"> 18 : break;</span></span> |
| <span id="L535"><span class="lineNum"> 535</span> : : }</span> |
| <span id="L536"><span class="lineNum"> 536</span> :<span class="tlaGNC"> 52 : dst += chunk;</span></span> |
| <span id="L537"><span class="lineNum"> 537</span> :<span class="tlaGNC"> 52 : src += chunk;</span></span> |
| <span id="L538"><span class="lineNum"> 538</span> :<span class="tlaGNC"> 52 : size -= chunk;</span></span> |
| <span id="L539"><span class="lineNum"> 539</span> : : }</span> |
| <span id="L540"><span class="lineNum"> 540</span> :<span class="tlaGNC"> 4 : return 0;</span></span> |
| <span id="L541"><span class="lineNum"> 541</span> : : }</span> |
| <span id="L542"><span class="lineNum"> 542</span> : : </span> |
| <span id="L543"><span class="lineNum"> 543</span> :<span class="tlaGNC"> 1 : int flash_smart_write_corrected(struct blocklevel_device *bl, uint32_t dst, const void *src,</span></span> |
| <span id="L544"><span class="lineNum"> 544</span> : : uint32_t size, bool ecc)</span> |
| <span id="L545"><span class="lineNum"> 545</span> : : {</span> |
| <span id="L546"><span class="lineNum"> 546</span> :<span class="tlaUNC tlaBgUNC"> 0 : struct ecc64 *buf;</span></span> |
| <span id="L547"><span class="lineNum"> 547</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L548"><span class="lineNum"> 548</span> : : </span> |
| <span id="L549"><span class="lineNum"> 549</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (!ecc)</span></span> |
| <span id="L550"><span class="lineNum"> 550</span> :<span class="tlaUNC tlaBgUNC"> 0 : return flash_smart_write(bl, dst, src, size);</span></span> |
| <span id="L551"><span class="lineNum"> 551</span> : : </span> |
| <span id="L552"><span class="lineNum"> 552</span> :<span class="tlaGNC tlaBgGNC"> 1 : buf = malloc(ecc_buffer_size(size));</span></span> |
| <span id="L553"><span class="lineNum"> 553</span> :<span class="tlaGNC"> 1 : if (!buf)</span></span> |
| <span id="L554"><span class="lineNum"> 554</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L555"><span class="lineNum"> 555</span> : : </span> |
| <span id="L556"><span class="lineNum"> 556</span> :<span class="tlaGNC tlaBgGNC"> 1 : rc = memcpy_to_ecc(buf, src, size);</span></span> |
| <span id="L557"><span class="lineNum"> 557</span> :<span class="tlaGNC"> 1 : if (rc) {</span></span> |
| <span id="L558"><span class="lineNum"> 558</span> :<span class="tlaUNC tlaBgUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L559"><span class="lineNum"> 559</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L560"><span class="lineNum"> 560</span> : : }</span> |
| <span id="L561"><span class="lineNum"> 561</span> : : </span> |
| <span id="L562"><span class="lineNum"> 562</span> :<span class="tlaGNC tlaBgGNC"> 1 : rc = flash_smart_write(bl, dst, buf, ecc_buffer_size(size));</span></span> |
| <span id="L563"><span class="lineNum"> 563</span> : : </span> |
| <span id="L564"><span class="lineNum"> 564</span> :<span class="tlaGNC"> 1 : out:</span></span> |
| <span id="L565"><span class="lineNum"> 565</span> :<span class="tlaGNC"> 1 : free(buf);</span></span> |
| <span id="L566"><span class="lineNum"> 566</span> :<span class="tlaGNC"> 1 : return rc;</span></span> |
| <span id="L567"><span class="lineNum"> 567</span> : : }</span> |
| <span id="L568"><span class="lineNum"> 568</span> : : </span> |
| <span id="L569"><span class="lineNum"> 569</span> :<span class="tlaGNC"> 1 : static int fl_chip_id(struct spi_flash_ctrl *ct, uint8_t *id_buf,</span></span> |
| <span id="L570"><span class="lineNum"> 570</span> : : uint32_t *id_size)</span> |
| <span id="L571"><span class="lineNum"> 571</span> : : {</span> |
| <span id="L572"><span class="lineNum"> 572</span> :<span class="tlaUNC tlaBgUNC"> 0 : int rc;</span></span> |
| <span id="L573"><span class="lineNum"> 573</span> :<span class="tlaUNC"> 0 : uint8_t stat;</span></span> |
| <span id="L574"><span class="lineNum"> 574</span> : : </span> |
| <span id="L575"><span class="lineNum"> 575</span> : : /* Check initial status */</span> |
| <span id="L576"><span class="lineNum"> 576</span> :<span class="tlaGNC tlaBgGNC"> 1 : rc = fl_read_stat(ct, &stat);</span></span> |
| <span id="L577"><span class="lineNum"> 577</span> :<span class="tlaGNC"> 1 : if (rc)</span></span> |
| <span id="L578"><span class="lineNum"> 578</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L579"><span class="lineNum"> 579</span> : : </span> |
| <span id="L580"><span class="lineNum"> 580</span> : : /* If stuck writing, wait for idle */</span> |
| <span id="L581"><span class="lineNum"> 581</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (stat & STAT_WIP) {</span></span> |
| <span id="L582"><span class="lineNum"> 582</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Flash in writing state ! Waiting...\n");</span></span> |
| <span id="L583"><span class="lineNum"> 583</span> :<span class="tlaUNC"> 0 : rc = fl_sync_wait_idle(ct);</span></span> |
| <span id="L584"><span class="lineNum"> 584</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L585"><span class="lineNum"> 585</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L586"><span class="lineNum"> 586</span> : : } else</span> |
| <span id="L587"><span class="lineNum"> 587</span> :<span class="tlaGNC tlaBgGNC"> 1 : FL_DBG("LIBFLASH: Init status: %02x\n", stat);</span></span> |
| <span id="L588"><span class="lineNum"> 588</span> : : </span> |
| <span id="L589"><span class="lineNum"> 589</span> : : /* Fallback to get ID manually */</span> |
| <span id="L590"><span class="lineNum"> 590</span> :<span class="tlaGNC"> 1 : rc = ct->cmd_rd(ct, CMD_RDID, false, 0, id_buf, 3);</span></span> |
| <span id="L591"><span class="lineNum"> 591</span> :<span class="tlaGNC"> 1 : if (rc)</span></span> |
| <span id="L592"><span class="lineNum"> 592</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L593"><span class="lineNum"> 593</span> :<span class="tlaGNC tlaBgGNC"> 1 : *id_size = 3;</span></span> |
| <span id="L594"><span class="lineNum"> 594</span> : : </span> |
| <span id="L595"><span class="lineNum"> 595</span> :<span class="tlaGNC"> 1 : return 0;</span></span> |
| <span id="L596"><span class="lineNum"> 596</span> : : }</span> |
| <span id="L597"><span class="lineNum"> 597</span> : : </span> |
| <span id="L598"><span class="lineNum"> 598</span> :<span class="tlaGNC"> 1 : static int flash_identify(struct flash_chip *c)</span></span> |
| <span id="L599"><span class="lineNum"> 599</span> : : {</span> |
| <span id="L600"><span class="lineNum"> 600</span> :<span class="tlaGNC"> 1 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L601"><span class="lineNum"> 601</span> :<span class="tlaGNC"> 1 : const struct flash_info *info = NULL;</span></span> |
| <span id="L602"><span class="lineNum"> 602</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint32_t iid, id_size;</span></span> |
| <span id="L603"><span class="lineNum"> 603</span> : : #define MAX_ID_SIZE 16</span> |
| <span id="L604"><span class="lineNum"> 604</span> :<span class="tlaUNC"> 0 : uint8_t id[MAX_ID_SIZE];</span></span> |
| <span id="L605"><span class="lineNum"> 605</span> :<span class="tlaUNC"> 0 : int rc, i;</span></span> |
| <span id="L606"><span class="lineNum"> 606</span> : : </span> |
| <span id="L607"><span class="lineNum"> 607</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (ct->chip_id) {</span></span> |
| <span id="L608"><span class="lineNum"> 608</span> : : /* High level controller interface */</span> |
| <span id="L609"><span class="lineNum"> 609</span> :<span class="tlaUNC tlaBgUNC"> 0 : id_size = MAX_ID_SIZE;</span></span> |
| <span id="L610"><span class="lineNum"> 610</span> :<span class="tlaUNC"> 0 : rc = ct->chip_id(ct, id, &id_size);</span></span> |
| <span id="L611"><span class="lineNum"> 611</span> : : } else</span> |
| <span id="L612"><span class="lineNum"> 612</span> :<span class="tlaGNC tlaBgGNC"> 1 : rc = fl_chip_id(ct, id, &id_size);</span></span> |
| <span id="L613"><span class="lineNum"> 613</span> :<span class="tlaGNC"> 1 : if (rc)</span></span> |
| <span id="L614"><span class="lineNum"> 614</span> :<span class="tlaUNC tlaBgUNC"> 0 : return rc;</span></span> |
| <span id="L615"><span class="lineNum"> 615</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (id_size < 3)</span></span> |
| <span id="L616"><span class="lineNum"> 616</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_CHIP_UNKNOWN;</span></span> |
| <span id="L617"><span class="lineNum"> 617</span> : : </span> |
| <span id="L618"><span class="lineNum"> 618</span> : : /* Convert to a dword for lookup */</span> |
| <span id="L619"><span class="lineNum"> 619</span> :<span class="tlaGNC tlaBgGNC"> 1 : iid = id[0];</span></span> |
| <span id="L620"><span class="lineNum"> 620</span> :<span class="tlaGNC"> 1 : iid = (iid << 8) | id[1];</span></span> |
| <span id="L621"><span class="lineNum"> 621</span> :<span class="tlaGNC"> 1 : iid = (iid << 8) | id[2];</span></span> |
| <span id="L622"><span class="lineNum"> 622</span> : : </span> |
| <span id="L623"><span class="lineNum"> 623</span> :<span class="tlaGNC"> 1 : FL_DBG("LIBFLASH: Flash ID: %02x.%02x.%02x (%06x)\n",</span></span> |
| <span id="L624"><span class="lineNum"> 624</span> : : id[0], id[1], id[2], iid);</span> |
| <span id="L625"><span class="lineNum"> 625</span> : : </span> |
| <span id="L626"><span class="lineNum"> 626</span> : : /* Lookup in flash_info */</span> |
| <span id="L627"><span class="lineNum"> 627</span> :<span class="tlaGNC"> 11 : for (i = 0; i < ARRAY_SIZE(flash_info); i++) {</span></span> |
| <span id="L628"><span class="lineNum"> 628</span> :<span class="tlaGNC"> 11 : info = &flash_info[i];</span></span> |
| <span id="L629"><span class="lineNum"> 629</span> :<span class="tlaGNC"> 11 : if (info->id == iid)</span></span> |
| <span id="L630"><span class="lineNum"> 630</span> :<span class="tlaGNC"> 1 : break; </span></span> |
| <span id="L631"><span class="lineNum"> 631</span> : : }</span> |
| <span id="L632"><span class="lineNum"> 632</span> :<span class="tlaGNC"> 1 : if (!info || info->id != iid)</span></span> |
| <span id="L633"><span class="lineNum"> 633</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_CHIP_UNKNOWN;</span></span> |
| <span id="L634"><span class="lineNum"> 634</span> : : </span> |
| <span id="L635"><span class="lineNum"> 635</span> :<span class="tlaGNC tlaBgGNC"> 1 : c->info = *info;</span></span> |
| <span id="L636"><span class="lineNum"> 636</span> :<span class="tlaGNC"> 1 : c->tsize = info->size;</span></span> |
| <span id="L637"><span class="lineNum"> 637</span> :<span class="tlaGNC"> 1 : ct->finfo = &c->info;</span></span> |
| <span id="L638"><span class="lineNum"> 638</span> : : </span> |
| <span id="L639"><span class="lineNum"> 639</span> : : /*</span> |
| <span id="L640"><span class="lineNum"> 640</span> : : * Let controller know about our settings and possibly</span> |
| <span id="L641"><span class="lineNum"> 641</span> : : * override them</span> |
| <span id="L642"><span class="lineNum"> 642</span> : : */</span> |
| <span id="L643"><span class="lineNum"> 643</span> :<span class="tlaGNC"> 1 : if (ct->setup) {</span></span> |
| <span id="L644"><span class="lineNum"> 644</span> :<span class="tlaUNC tlaBgUNC"> 0 : rc = ct->setup(ct, &c->tsize);</span></span> |
| <span id="L645"><span class="lineNum"> 645</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L646"><span class="lineNum"> 646</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L647"><span class="lineNum"> 647</span> : : }</span> |
| <span id="L648"><span class="lineNum"> 648</span> : : </span> |
| <span id="L649"><span class="lineNum"> 649</span> : : /* Calculate min erase granularity */</span> |
| <span id="L650"><span class="lineNum"> 650</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (c->info.flags & FL_ERASE_4K)</span></span> |
| <span id="L651"><span class="lineNum"> 651</span> :<span class="tlaGNC"> 1 : c->min_erase_mask = 0xfff;</span></span> |
| <span id="L652"><span class="lineNum"> 652</span> :<span class="tlaUNC tlaBgUNC"> 0 : else if (c->info.flags & FL_ERASE_32K)</span></span> |
| <span id="L653"><span class="lineNum"> 653</span> :<span class="tlaUNC"> 0 : c->min_erase_mask = 0x7fff;</span></span> |
| <span id="L654"><span class="lineNum"> 654</span> :<span class="tlaUNC"> 0 : else if (c->info.flags & FL_ERASE_64K)</span></span> |
| <span id="L655"><span class="lineNum"> 655</span> :<span class="tlaUNC"> 0 : c->min_erase_mask = 0xffff;</span></span> |
| <span id="L656"><span class="lineNum"> 656</span> : : else {</span> |
| <span id="L657"><span class="lineNum"> 657</span> : : /* No erase size ? oops ... */</span> |
| <span id="L658"><span class="lineNum"> 658</span> :<span class="tlaUNC"> 0 : FL_ERR("LIBFLASH: No erase sizes !\n");</span></span> |
| <span id="L659"><span class="lineNum"> 659</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_CTRL_CONFIG_MISMATCH;</span></span> |
| <span id="L660"><span class="lineNum"> 660</span> : : }</span> |
| <span id="L661"><span class="lineNum"> 661</span> : : </span> |
| <span id="L662"><span class="lineNum"> 662</span> :<span class="tlaGNC tlaBgGNC"> 1 : FL_DBG("LIBFLASH: Found chip %s size %dM erase granule: %dK\n",</span></span> |
| <span id="L663"><span class="lineNum"> 663</span> : : c->info.name, c->tsize >> 20, (c->min_erase_mask + 1) >> 10);</span> |
| <span id="L664"><span class="lineNum"> 664</span> : : </span> |
| <span id="L665"><span class="lineNum"> 665</span> :<span class="tlaGNC"> 1 : return 0;</span></span> |
| <span id="L666"><span class="lineNum"> 666</span> : : }</span> |
| <span id="L667"><span class="lineNum"> 667</span> : : </span> |
| <span id="L668"><span class="lineNum"> 668</span> :<span class="tlaGNC"> 1 : static int flash_set_4b(struct flash_chip *c, bool enable)</span></span> |
| <span id="L669"><span class="lineNum"> 669</span> : : {</span> |
| <span id="L670"><span class="lineNum"> 670</span> :<span class="tlaGNC"> 1 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L671"><span class="lineNum"> 671</span> :<span class="tlaUNC tlaBgUNC"> 0 : int rc;</span></span> |
| <span id="L672"><span class="lineNum"> 672</span> : : </span> |
| <span id="L673"><span class="lineNum"> 673</span> : : /* Don't have low level interface, assume all is well */</span> |
| <span id="L674"><span class="lineNum"> 674</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (!ct->cmd_wr)</span></span> |
| <span id="L675"><span class="lineNum"> 675</span> :<span class="tlaUNC tlaBgUNC"> 0 : return 0;</span></span> |
| <span id="L676"><span class="lineNum"> 676</span> : : </span> |
| <span id="L677"><span class="lineNum"> 677</span> : : /* Some flash chips want this */</span> |
| <span id="L678"><span class="lineNum"> 678</span> :<span class="tlaGNC tlaBgGNC"> 1 : rc = fl_wren(ct);</span></span> |
| <span id="L679"><span class="lineNum"> 679</span> :<span class="tlaGNC"> 1 : if (rc) {</span></span> |
| <span id="L680"><span class="lineNum"> 680</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Error %d enabling write for set_4b\n", rc);</span></span> |
| <span id="L681"><span class="lineNum"> 681</span> : : /* Ignore the error & move on (could be wrprotect chip) */</span> |
| <span id="L682"><span class="lineNum"> 682</span> : : }</span> |
| <span id="L683"><span class="lineNum"> 683</span> : : </span> |
| <span id="L684"><span class="lineNum"> 684</span> : : /* Ignore error in case chip is write protected */</span> |
| <span id="L685"><span class="lineNum"> 685</span> :<span class="tlaGNC tlaBgGNC"> 1 : return ct->cmd_wr(ct, enable ? CMD_EN4B : CMD_EX4B, false, 0, NULL, 0);</span></span> |
| <span id="L686"><span class="lineNum"> 686</span> : : }</span> |
| <span id="L687"><span class="lineNum"> 687</span> : : </span> |
| <span id="L688"><span class="lineNum"> 688</span> :<span class="tlaUNC tlaBgUNC"> 0 : int flash_force_4b_mode(struct flash_chip *c, bool enable_4b)</span></span> |
| <span id="L689"><span class="lineNum"> 689</span> : : {</span> |
| <span id="L690"><span class="lineNum"> 690</span> :<span class="tlaUNC"> 0 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L691"><span class="lineNum"> 691</span> :<span class="tlaUNC"> 0 : int rc = FLASH_ERR_4B_NOT_SUPPORTED;</span></span> |
| <span id="L692"><span class="lineNum"> 692</span> : : </span> |
| <span id="L693"><span class="lineNum"> 693</span> : : /*</span> |
| <span id="L694"><span class="lineNum"> 694</span> : : * We only allow force 4b if both controller and flash do 4b</span> |
| <span id="L695"><span class="lineNum"> 695</span> : : * as this is mainly used if a 3rd party tries to directly</span> |
| <span id="L696"><span class="lineNum"> 696</span> : : * access a direct mapped read region</span> |
| <span id="L697"><span class="lineNum"> 697</span> : : */</span> |
| <span id="L698"><span class="lineNum"> 698</span> :<span class="tlaUNC"> 0 : if (enable_4b && !((c->info.flags & FL_CAN_4B) && ct->set_4b))</span></span> |
| <span id="L699"><span class="lineNum"> 699</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L700"><span class="lineNum"> 700</span> : : </span> |
| <span id="L701"><span class="lineNum"> 701</span> : : /* Only send to flash directly on controllers that implement</span> |
| <span id="L702"><span class="lineNum"> 702</span> : : * the low level callbacks</span> |
| <span id="L703"><span class="lineNum"> 703</span> : : */</span> |
| <span id="L704"><span class="lineNum"> 704</span> :<span class="tlaUNC"> 0 : if (ct->cmd_wr) {</span></span> |
| <span id="L705"><span class="lineNum"> 705</span> :<span class="tlaUNC"> 0 : rc = flash_set_4b(c, enable_4b);</span></span> |
| <span id="L706"><span class="lineNum"> 706</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L707"><span class="lineNum"> 707</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L708"><span class="lineNum"> 708</span> : : }</span> |
| <span id="L709"><span class="lineNum"> 709</span> : : </span> |
| <span id="L710"><span class="lineNum"> 710</span> : : /* Then inform the controller */</span> |
| <span id="L711"><span class="lineNum"> 711</span> :<span class="tlaUNC"> 0 : if (ct->set_4b)</span></span> |
| <span id="L712"><span class="lineNum"> 712</span> :<span class="tlaUNC"> 0 : rc = ct->set_4b(ct, enable_4b);</span></span> |
| <span id="L713"><span class="lineNum"> 713</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L714"><span class="lineNum"> 714</span> : : }</span> |
| <span id="L715"><span class="lineNum"> 715</span> : : </span> |
| <span id="L716"><span class="lineNum"> 716</span> :<span class="tlaGNC tlaBgGNC"> 1 : static int flash_configure(struct flash_chip *c)</span></span> |
| <span id="L717"><span class="lineNum"> 717</span> : : {</span> |
| <span id="L718"><span class="lineNum"> 718</span> :<span class="tlaGNC"> 1 : struct spi_flash_ctrl *ct = c->ctrl;</span></span> |
| <span id="L719"><span class="lineNum"> 719</span> :<span class="tlaUNC tlaBgUNC"> 0 : int rc;</span></span> |
| <span id="L720"><span class="lineNum"> 720</span> : : </span> |
| <span id="L721"><span class="lineNum"> 721</span> : : /* Crop flash size if necessary */</span> |
| <span id="L722"><span class="lineNum"> 722</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (c->tsize > 0x01000000 && !(c->info.flags & FL_CAN_4B)) {</span></span> |
| <span id="L723"><span class="lineNum"> 723</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Flash chip cropped to 16M, no 4b mode\n");</span></span> |
| <span id="L724"><span class="lineNum"> 724</span> :<span class="tlaUNC"> 0 : c->tsize = 0x01000000;</span></span> |
| <span id="L725"><span class="lineNum"> 725</span> : : }</span> |
| <span id="L726"><span class="lineNum"> 726</span> : : </span> |
| <span id="L727"><span class="lineNum"> 727</span> : : /* If flash chip > 16M, enable 4b mode */</span> |
| <span id="L728"><span class="lineNum"> 728</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (c->tsize > 0x01000000) {</span></span> |
| <span id="L729"><span class="lineNum"> 729</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("LIBFLASH: Flash >16MB, enabling 4B mode...\n");</span></span> |
| <span id="L730"><span class="lineNum"> 730</span> : : </span> |
| <span id="L731"><span class="lineNum"> 731</span> : : /* Set flash to 4b mode if we can */</span> |
| <span id="L732"><span class="lineNum"> 732</span> :<span class="tlaUNC"> 0 : if (ct->cmd_wr) {</span></span> |
| <span id="L733"><span class="lineNum"> 733</span> :<span class="tlaUNC"> 0 : rc = flash_set_4b(c, true);</span></span> |
| <span id="L734"><span class="lineNum"> 734</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L735"><span class="lineNum"> 735</span> :<span class="tlaUNC"> 0 : FL_ERR("LIBFLASH: Failed to set flash 4b mode\n");</span></span> |
| <span id="L736"><span class="lineNum"> 736</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L737"><span class="lineNum"> 737</span> : : }</span> |
| <span id="L738"><span class="lineNum"> 738</span> : : }</span> |
| <span id="L739"><span class="lineNum"> 739</span> : : </span> |
| <span id="L740"><span class="lineNum"> 740</span> : : </span> |
| <span id="L741"><span class="lineNum"> 741</span> : : /* Set controller to 4b mode if supported */</span> |
| <span id="L742"><span class="lineNum"> 742</span> :<span class="tlaUNC"> 0 : if (ct->set_4b) {</span></span> |
| <span id="L743"><span class="lineNum"> 743</span> :<span class="tlaUNC"> 0 : FL_DBG("LIBFLASH: Enabling controller 4B mode...\n");</span></span> |
| <span id="L744"><span class="lineNum"> 744</span> :<span class="tlaUNC"> 0 : rc = ct->set_4b(ct, true);</span></span> |
| <span id="L745"><span class="lineNum"> 745</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L746"><span class="lineNum"> 746</span> :<span class="tlaUNC"> 0 : FL_ERR("LIBFLASH: Failed to set controller 4b mode\n");</span></span> |
| <span id="L747"><span class="lineNum"> 747</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L748"><span class="lineNum"> 748</span> : : }</span> |
| <span id="L749"><span class="lineNum"> 749</span> : : }</span> |
| <span id="L750"><span class="lineNum"> 750</span> : : } else {</span> |
| <span id="L751"><span class="lineNum"> 751</span> :<span class="tlaGNC tlaBgGNC"> 1 : FL_DBG("LIBFLASH: Flash <=16MB, disabling 4B mode...\n");</span></span> |
| <span id="L752"><span class="lineNum"> 752</span> : : </span> |
| <span id="L753"><span class="lineNum"> 753</span> : : /*</span> |
| <span id="L754"><span class="lineNum"> 754</span> : : * If flash chip supports 4b mode, make sure we disable</span> |
| <span id="L755"><span class="lineNum"> 755</span> : : * it in case it was left over by the previous user</span> |
| <span id="L756"><span class="lineNum"> 756</span> : : */</span> |
| <span id="L757"><span class="lineNum"> 757</span> :<span class="tlaGNC"> 1 : if (c->info.flags & FL_CAN_4B) {</span></span> |
| <span id="L758"><span class="lineNum"> 758</span> :<span class="tlaGNC"> 1 : rc = flash_set_4b(c, false);</span></span> |
| <span id="L759"><span class="lineNum"> 759</span> :<span class="tlaGNC"> 1 : if (rc) {</span></span> |
| <span id="L760"><span class="lineNum"> 760</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Failed to"</span></span> |
| <span id="L761"><span class="lineNum"> 761</span> : : " clear flash 4b mode\n");</span> |
| <span id="L762"><span class="lineNum"> 762</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L763"><span class="lineNum"> 763</span> : : }</span> |
| <span id="L764"><span class="lineNum"> 764</span> : : }</span> |
| <span id="L765"><span class="lineNum"> 765</span> : : /* Set controller to 3b mode if mode switch is supported */</span> |
| <span id="L766"><span class="lineNum"> 766</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (ct->set_4b) {</span></span> |
| <span id="L767"><span class="lineNum"> 767</span> :<span class="tlaGNC"> 1 : FL_DBG("LIBFLASH: Disabling controller 4B mode...\n");</span></span> |
| <span id="L768"><span class="lineNum"> 768</span> :<span class="tlaGNC"> 1 : rc = ct->set_4b(ct, false);</span></span> |
| <span id="L769"><span class="lineNum"> 769</span> :<span class="tlaGNC"> 1 : if (rc) {</span></span> |
| <span id="L770"><span class="lineNum"> 770</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Failed to"</span></span> |
| <span id="L771"><span class="lineNum"> 771</span> : : " clear controller 4b mode\n");</span> |
| <span id="L772"><span class="lineNum"> 772</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L773"><span class="lineNum"> 773</span> : : }</span> |
| <span id="L774"><span class="lineNum"> 774</span> : : }</span> |
| <span id="L775"><span class="lineNum"> 775</span> : : }</span> |
| <span id="L776"><span class="lineNum"> 776</span> :<span class="tlaGNC tlaBgGNC"> 1 : return 0;</span></span> |
| <span id="L777"><span class="lineNum"> 777</span> : : }</span> |
| <span id="L778"><span class="lineNum"> 778</span> : : </span> |
| <span id="L779"><span class="lineNum"> 779</span> :<span class="tlaGNC"> 1 : static int flash_get_info(struct blocklevel_device *bl, const char **name,</span></span> |
| <span id="L780"><span class="lineNum"> 780</span> : : uint64_t *total_size, uint32_t *erase_granule)</span> |
| <span id="L781"><span class="lineNum"> 781</span> : : {</span> |
| <span id="L782"><span class="lineNum"> 782</span> :<span class="tlaGNC"> 1 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L783"><span class="lineNum"> 783</span> :<span class="tlaGNC"> 1 : if (name)</span></span> |
| <span id="L784"><span class="lineNum"> 784</span> :<span class="tlaGNC"> 1 : *name = c->info.name;</span></span> |
| <span id="L785"><span class="lineNum"> 785</span> :<span class="tlaGNC"> 1 : if (total_size)</span></span> |
| <span id="L786"><span class="lineNum"> 786</span> :<span class="tlaGNC"> 1 : *total_size = c->tsize;</span></span> |
| <span id="L787"><span class="lineNum"> 787</span> :<span class="tlaGNC"> 1 : if (erase_granule)</span></span> |
| <span id="L788"><span class="lineNum"> 788</span> :<span class="tlaGNC"> 1 : *erase_granule = c->min_erase_mask + 1;</span></span> |
| <span id="L789"><span class="lineNum"> 789</span> :<span class="tlaGNC"> 1 : return 0;</span></span> |
| <span id="L790"><span class="lineNum"> 790</span> : : }</span> |
| <span id="L791"><span class="lineNum"> 791</span> : : </span> |
| <span id="L792"><span class="lineNum"> 792</span> :<span class="tlaGNC"> 1 : int flash_init(struct spi_flash_ctrl *ctrl, struct blocklevel_device **bl,</span></span> |
| <span id="L793"><span class="lineNum"> 793</span> : : struct flash_chip **flash_chip)</span> |
| <span id="L794"><span class="lineNum"> 794</span> : : {</span> |
| <span id="L795"><span class="lineNum"> 795</span> :<span class="tlaUNC tlaBgUNC"> 0 : struct flash_chip *c;</span></span> |
| <span id="L796"><span class="lineNum"> 796</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L797"><span class="lineNum"> 797</span> : : </span> |
| <span id="L798"><span class="lineNum"> 798</span> :<span class="tlaGNC tlaBgGNC"> 1 : if (!bl)</span></span> |
| <span id="L799"><span class="lineNum"> 799</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L800"><span class="lineNum"> 800</span> : : </span> |
| <span id="L801"><span class="lineNum"> 801</span> :<span class="tlaGNC tlaBgGNC"> 1 : *bl = NULL;</span></span> |
| <span id="L802"><span class="lineNum"> 802</span> : : </span> |
| <span id="L803"><span class="lineNum"> 803</span> :<span class="tlaGNC"> 1 : c = malloc(sizeof(struct flash_chip));</span></span> |
| <span id="L804"><span class="lineNum"> 804</span> :<span class="tlaGNC"> 1 : if (!c)</span></span> |
| <span id="L805"><span class="lineNum"> 805</span> :<span class="tlaUNC tlaBgUNC"> 0 : return FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L806"><span class="lineNum"> 806</span> :<span class="tlaGNC tlaBgGNC"> 1 : memset(c, 0, sizeof(*c));</span></span> |
| <span id="L807"><span class="lineNum"> 807</span> :<span class="tlaGNC"> 1 : c->ctrl = ctrl;</span></span> |
| <span id="L808"><span class="lineNum"> 808</span> : : </span> |
| <span id="L809"><span class="lineNum"> 809</span> :<span class="tlaGNC"> 1 : rc = flash_identify(c);</span></span> |
| <span id="L810"><span class="lineNum"> 810</span> :<span class="tlaGNC"> 1 : if (rc) {</span></span> |
| <span id="L811"><span class="lineNum"> 811</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Flash identification failed\n");</span></span> |
| <span id="L812"><span class="lineNum"> 812</span> :<span class="tlaUNC"> 0 : goto bail;</span></span> |
| <span id="L813"><span class="lineNum"> 813</span> : : }</span> |
| <span id="L814"><span class="lineNum"> 814</span> :<span class="tlaGNC tlaBgGNC"> 1 : c->smart_buf = malloc(c->min_erase_mask + 1);</span></span> |
| <span id="L815"><span class="lineNum"> 815</span> :<span class="tlaGNC"> 1 : if (!c->smart_buf) {</span></span> |
| <span id="L816"><span class="lineNum"> 816</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Failed to allocate smart buffer !\n");</span></span> |
| <span id="L817"><span class="lineNum"> 817</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L818"><span class="lineNum"> 818</span> :<span class="tlaUNC"> 0 : goto bail;</span></span> |
| <span id="L819"><span class="lineNum"> 819</span> : : }</span> |
| <span id="L820"><span class="lineNum"> 820</span> :<span class="tlaGNC tlaBgGNC"> 1 : rc = flash_configure(c);</span></span> |
| <span id="L821"><span class="lineNum"> 821</span> :<span class="tlaGNC"> 1 : if (rc)</span></span> |
| <span id="L822"><span class="lineNum"> 822</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("LIBFLASH: Flash configuration failed\n");</span></span> |
| <span id="L823"><span class="lineNum"> 823</span> :<span class="tlaGNC tlaBgGNC"> 1 : bail:</span></span> |
| <span id="L824"><span class="lineNum"> 824</span> :<span class="tlaGNC"> 1 : if (rc) {</span></span> |
| <span id="L825"><span class="lineNum"> 825</span> :<span class="tlaUNC tlaBgUNC"> 0 : free(c);</span></span> |
| <span id="L826"><span class="lineNum"> 826</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L827"><span class="lineNum"> 827</span> : : }</span> |
| <span id="L828"><span class="lineNum"> 828</span> : : </span> |
| <span id="L829"><span class="lineNum"> 829</span> : : /* The flash backend doesn't support reiniting it */</span> |
| <span id="L830"><span class="lineNum"> 830</span> :<span class="tlaGNC tlaBgGNC"> 1 : c->bl.keep_alive = true;</span></span> |
| <span id="L831"><span class="lineNum"> 831</span> :<span class="tlaGNC"> 1 : c->bl.reacquire = NULL;</span></span> |
| <span id="L832"><span class="lineNum"> 832</span> :<span class="tlaGNC"> 1 : c->bl.release = NULL;</span></span> |
| <span id="L833"><span class="lineNum"> 833</span> :<span class="tlaGNC"> 1 : c->bl.read = &flash_read;</span></span> |
| <span id="L834"><span class="lineNum"> 834</span> :<span class="tlaGNC"> 1 : c->bl.write = &flash_smart_write;</span></span> |
| <span id="L835"><span class="lineNum"> 835</span> :<span class="tlaGNC"> 1 : c->bl.erase = &flash_erase;</span></span> |
| <span id="L836"><span class="lineNum"> 836</span> :<span class="tlaGNC"> 1 : c->bl.get_info = &flash_get_info;</span></span> |
| <span id="L837"><span class="lineNum"> 837</span> :<span class="tlaGNC"> 1 : c->bl.erase_mask = c->min_erase_mask;</span></span> |
| <span id="L838"><span class="lineNum"> 838</span> :<span class="tlaGNC"> 1 : c->bl.flags = WRITE_NEED_ERASE;</span></span> |
| <span id="L839"><span class="lineNum"> 839</span> : : </span> |
| <span id="L840"><span class="lineNum"> 840</span> :<span class="tlaGNC"> 1 : *bl = &(c->bl);</span></span> |
| <span id="L841"><span class="lineNum"> 841</span> :<span class="tlaGNC"> 1 : if (flash_chip)</span></span> |
| <span id="L842"><span class="lineNum"> 842</span> :<span class="tlaUNC tlaBgUNC"> 0 : *flash_chip = c;</span></span> |
| <span id="L843"><span class="lineNum"> 843</span> : : </span> |
| <span id="L844"><span class="lineNum"> 844</span> :<span class="tlaGNC tlaBgGNC"> 1 : return 0;</span></span> |
| <span id="L845"><span class="lineNum"> 845</span> : : }</span> |
| <span id="L846"><span class="lineNum"> 846</span> : : </span> |
| <span id="L847"><span class="lineNum"> 847</span> :<span class="tlaGNC"> 1 : void flash_exit(struct blocklevel_device *bl)</span></span> |
| <span id="L848"><span class="lineNum"> 848</span> : : {</span> |
| <span id="L849"><span class="lineNum"> 849</span> : : /* XXX Make sure we are idle etc... */</span> |
| <span id="L850"><span class="lineNum"> 850</span> :<span class="tlaGNC"> 1 : if (bl) {</span></span> |
| <span id="L851"><span class="lineNum"> 851</span> :<span class="tlaGNC"> 1 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L852"><span class="lineNum"> 852</span> :<span class="tlaGNC"> 1 : free(c->smart_buf);</span></span> |
| <span id="L853"><span class="lineNum"> 853</span> :<span class="tlaGNC"> 1 : free(c);</span></span> |
| <span id="L854"><span class="lineNum"> 854</span> : : }</span> |
| <span id="L855"><span class="lineNum"> 855</span> :<span class="tlaGNC"> 1 : }</span></span> |
| <span id="L856"><span class="lineNum"> 856</span> : : </span> |
| <span id="L857"><span class="lineNum"> 857</span> :<span class="tlaUNC tlaBgUNC"> 0 : void flash_exit_close(struct blocklevel_device *bl, void (*close)(struct spi_flash_ctrl *ctrl))</span></span> |
| <span id="L858"><span class="lineNum"> 858</span> : : {</span> |
| <span id="L859"><span class="lineNum"> 859</span> :<span class="tlaUNC"> 0 : if (bl) {</span></span> |
| <span id="L860"><span class="lineNum"> 860</span> :<span class="tlaUNC"> 0 : struct flash_chip *c = container_of(bl, struct flash_chip, bl);</span></span> |
| <span id="L861"><span class="lineNum"> 861</span> :<span class="tlaUNC"> 0 : close(c->ctrl);</span></span> |
| <span id="L862"><span class="lineNum"> 862</span> :<span class="tlaUNC"> 0 : free(c);</span></span> |
| <span id="L863"><span class="lineNum"> 863</span> : : }</span> |
| <span id="L864"><span class="lineNum"> 864</span> :<span class="tlaUNC"> 0 : }</span></span> |
| </pre> |
| </td> |
| </tr> |
| </table> |
| <br> |
| |
| <table width="100%" border=0 cellspacing=0 cellpadding=0> |
| <tr><td class="ruler"><img src="../glass.png" width=3 height=3 alt=""></td></tr> |
| <tr><td class="versionInfo">Generated by: <a href="https://github.com//linux-test-project/lcov" target="_parent">LCOV version 2.0-1</a></td></tr> |
| </table> |
| <br> |
| |
| </body> |
| </html> |
