| <!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 - external/ffspart/libflash/blocklevel.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">external/ffspart/libflash</a> - blocklevel.c<span style="font-size: 80%;"> (source / <a href="blocklevel.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">25.7 %</td> |
| <td class="headerCovTableEntry">382</td> |
| <td class="headerCovTableEntry">98</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="headerCovTableEntryLo">57.1 %</td> |
| <td class="headerCovTableEntry">14</td> |
| <td class="headerCovTableEntry">8</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-2018 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 <unistd.h></span> |
| <span id="L6"><span class="lineNum"> 6</span> : : #include <stdio.h></span> |
| <span id="L7"><span class="lineNum"> 7</span> : : #include <stdbool.h></span> |
| <span id="L8"><span class="lineNum"> 8</span> : : #include <errno.h></span> |
| <span id="L9"><span class="lineNum"> 9</span> : : #include <string.h></span> |
| <span id="L10"><span class="lineNum"> 10</span> : : #include <inttypes.h></span> |
| <span id="L11"><span class="lineNum"> 11</span> : : </span> |
| <span id="L12"><span class="lineNum"> 12</span> : : #include <libflash/libflash.h></span> |
| <span id="L13"><span class="lineNum"> 13</span> : : #include <libflash/errors.h></span> |
| <span id="L14"><span class="lineNum"> 14</span> : : </span> |
| <span id="L15"><span class="lineNum"> 15</span> : : #include "blocklevel.h"</span> |
| <span id="L16"><span class="lineNum"> 16</span> : : #include "ecc.h"</span> |
| <span id="L17"><span class="lineNum"> 17</span> : : </span> |
| <span id="L18"><span class="lineNum"> 18</span> : : #define PROT_REALLOC_NUM 25</span> |
| <span id="L19"><span class="lineNum"> 19</span> : : </span> |
| <span id="L20"><span class="lineNum"> 20</span> : : /* This function returns tristate values.</span> |
| <span id="L21"><span class="lineNum"> 21</span> : : * 1 - The region is ECC protected</span> |
| <span id="L22"><span class="lineNum"> 22</span> : : * 0 - The region is not ECC protected</span> |
| <span id="L23"><span class="lineNum"> 23</span> : : * -1 - Partially protected</span> |
| <span id="L24"><span class="lineNum"> 24</span> : : */</span> |
| <span id="L25"><span class="lineNum"> 25</span> :<span class="tlaGNC tlaBgGNC"> 34 : static int ecc_protected(struct blocklevel_device *bl, uint64_t pos, uint64_t len, uint64_t *start)</span></span> |
| <span id="L26"><span class="lineNum"> 26</span> : : {</span> |
| <span id="L27"><span class="lineNum"> 27</span> :<span class="tlaGNC"> 34 : int i;</span></span> |
| <span id="L28"><span class="lineNum"> 28</span> : : </span> |
| <span id="L29"><span class="lineNum"> 29</span> : : /* Length of 0 is nonsensical so add 1 */</span> |
| <span id="L30"><span class="lineNum"> 30</span> :<span class="tlaGNC"> 34 : if (len == 0)</span></span> |
| <span id="L31"><span class="lineNum"> 31</span> : : len = 1;</span> |
| <span id="L32"><span class="lineNum"> 32</span> : : </span> |
| <span id="L33"><span class="lineNum"> 33</span> :<span class="tlaGNC"> 92 : for (i = 0; i < bl->ecc_prot.n_prot; i++) {</span></span> |
| <span id="L34"><span class="lineNum"> 34</span> : : /* Fits entirely within the range */</span> |
| <span id="L35"><span class="lineNum"> 35</span> :<span class="tlaGNC"> 78 : if (bl->ecc_prot.prot[i].start <= pos &&</span></span> |
| <span id="L36"><span class="lineNum"> 36</span> :<span class="tlaGNC"> 58 : bl->ecc_prot.prot[i].start + bl->ecc_prot.prot[i].len >= pos + len) {</span></span> |
| <span id="L37"><span class="lineNum"> 37</span> :<span class="tlaGNC"> 20 : if (start)</span></span> |
| <span id="L38"><span class="lineNum"> 38</span> :<span class="tlaGNC"> 20 : *start = bl->ecc_prot.prot[i].start;</span></span> |
| <span id="L39"><span class="lineNum"> 39</span> :<span class="tlaGNC"> 20 : return 1;</span></span> |
| <span id="L40"><span class="lineNum"> 40</span> : : }</span> |
| <span id="L41"><span class="lineNum"> 41</span> : : </span> |
| <span id="L42"><span class="lineNum"> 42</span> : : /*</span> |
| <span id="L43"><span class="lineNum"> 43</span> : : * Even if ranges are merged we can't currently guarantee two</span> |
| <span id="L44"><span class="lineNum"> 44</span> : : * contiguous regions are sanely ECC protected so a partial fit</span> |
| <span id="L45"><span class="lineNum"> 45</span> : : * is no good.</span> |
| <span id="L46"><span class="lineNum"> 46</span> : : */</span> |
| <span id="L47"><span class="lineNum"> 47</span> :<span class="tlaGNC"> 58 : if ((bl->ecc_prot.prot[i].start >= pos && bl->ecc_prot.prot[i].start < pos + len) ||</span></span> |
| <span id="L48"><span class="lineNum"> 48</span> :<span class="tlaGNC"> 38 : (bl->ecc_prot.prot[i].start <= pos &&</span></span> |
| <span id="L49"><span class="lineNum"> 49</span> :<span class="tlaGNC"> 38 : bl->ecc_prot.prot[i].start + bl->ecc_prot.prot[i].len > pos)) {</span></span> |
| <span id="L50"><span class="lineNum"> 50</span> :<span class="tlaUNC tlaBgUNC"> 0 : if (start)</span></span> |
| <span id="L51"><span class="lineNum"> 51</span> :<span class="tlaUNC"> 0 : *start = bl->ecc_prot.prot[i].start;</span></span> |
| <span id="L52"><span class="lineNum"> 52</span> :<span class="tlaUNC"> 0 : return -1;</span></span> |
| <span id="L53"><span class="lineNum"> 53</span> : : }</span> |
| <span id="L54"><span class="lineNum"> 54</span> : : }</span> |
| <span id="L55"><span class="lineNum"> 55</span> : : return 0;</span> |
| <span id="L56"><span class="lineNum"> 56</span> : : }</span> |
| <span id="L57"><span class="lineNum"> 57</span> : : </span> |
| <span id="L58"><span class="lineNum"> 58</span> :<span class="tlaGNC tlaBgGNC"> 20 : static uint64_t with_ecc_pos(uint64_t ecc_start, uint64_t pos)</span></span> |
| <span id="L59"><span class="lineNum"> 59</span> : : {</span> |
| <span id="L60"><span class="lineNum"> 60</span> :<span class="tlaGNC"> 20 : return pos + ((pos - ecc_start) / (BYTES_PER_ECC));</span></span> |
| <span id="L61"><span class="lineNum"> 61</span> : : }</span> |
| <span id="L62"><span class="lineNum"> 62</span> : : </span> |
| <span id="L63"><span class="lineNum"> 63</span> :<span class="tlaGNC"> 46 : static int reacquire(struct blocklevel_device *bl)</span></span> |
| <span id="L64"><span class="lineNum"> 64</span> : : {</span> |
| <span id="L65"><span class="lineNum"> 65</span> :<span class="tlaGNC"> 46 : if (!bl->keep_alive && bl->reacquire)</span></span> |
| <span id="L66"><span class="lineNum"> 66</span> :<span class="tlaUNC tlaBgUNC"> 0 : return bl->reacquire(bl);</span></span> |
| <span id="L67"><span class="lineNum"> 67</span> : : return 0;</span> |
| <span id="L68"><span class="lineNum"> 68</span> : : }</span> |
| <span id="L69"><span class="lineNum"> 69</span> : : </span> |
| <span id="L70"><span class="lineNum"> 70</span> :<span class="tlaGNC tlaBgGNC"> 46 : static int release(struct blocklevel_device *bl)</span></span> |
| <span id="L71"><span class="lineNum"> 71</span> : : {</span> |
| <span id="L72"><span class="lineNum"> 72</span> :<span class="tlaGNC"> 46 : int rc = 0;</span></span> |
| <span id="L73"><span class="lineNum"> 73</span> :<span class="tlaGNC"> 46 : if (!bl->keep_alive && bl->release) {</span></span> |
| <span id="L74"><span class="lineNum"> 74</span> : : /* This is the error return path a lot, preserve errno */</span> |
| <span id="L75"><span class="lineNum"> 75</span> :<span class="tlaUNC tlaBgUNC"> 0 : int err = errno;</span></span> |
| <span id="L76"><span class="lineNum"> 76</span> :<span class="tlaUNC"> 0 : rc = bl->release(bl);</span></span> |
| <span id="L77"><span class="lineNum"> 77</span> :<span class="tlaUNC"> 0 : errno = err;</span></span> |
| <span id="L78"><span class="lineNum"> 78</span> : : }</span> |
| <span id="L79"><span class="lineNum"> 79</span> :<span class="tlaGNC tlaBgGNC"> 46 : return rc;</span></span> |
| <span id="L80"><span class="lineNum"> 80</span> : : }</span> |
| <span id="L81"><span class="lineNum"> 81</span> : : </span> |
| <span id="L82"><span class="lineNum"> 82</span> :<span class="tlaUNC tlaBgUNC"> 0 : int blocklevel_raw_read(struct blocklevel_device *bl, uint64_t pos, void *buf, uint64_t len)</span></span> |
| <span id="L83"><span class="lineNum"> 83</span> : : {</span> |
| <span id="L84"><span class="lineNum"> 84</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L85"><span class="lineNum"> 85</span> : : </span> |
| <span id="L86"><span class="lineNum"> 86</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: 0x%" PRIx64 "\t%p\t0x%" PRIx64 "\n", __func__, pos, buf, len);</span></span> |
| <span id="L87"><span class="lineNum"> 87</span> :<span class="tlaUNC"> 0 : if (!bl || !bl->read || !buf) {</span></span> |
| <span id="L88"><span class="lineNum"> 88</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L89"><span class="lineNum"> 89</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L90"><span class="lineNum"> 90</span> : : }</span> |
| <span id="L91"><span class="lineNum"> 91</span> : : </span> |
| <span id="L92"><span class="lineNum"> 92</span> :<span class="tlaUNC"> 0 : rc = reacquire(bl);</span></span> |
| <span id="L93"><span class="lineNum"> 93</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L94"><span class="lineNum"> 94</span> : : return rc;</span> |
| <span id="L95"><span class="lineNum"> 95</span> : : </span> |
| <span id="L96"><span class="lineNum"> 96</span> :<span class="tlaUNC"> 0 : rc = bl->read(bl, pos, buf, len);</span></span> |
| <span id="L97"><span class="lineNum"> 97</span> : : </span> |
| <span id="L98"><span class="lineNum"> 98</span> :<span class="tlaUNC"> 0 : release(bl);</span></span> |
| <span id="L99"><span class="lineNum"> 99</span> : : </span> |
| <span id="L100"><span class="lineNum"> 100</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L101"><span class="lineNum"> 101</span> : : }</span> |
| <span id="L102"><span class="lineNum"> 102</span> : : </span> |
| <span id="L103"><span class="lineNum"> 103</span> :<span class="tlaUNC"> 0 : int blocklevel_read(struct blocklevel_device *bl, uint64_t pos, void *buf, uint64_t len)</span></span> |
| <span id="L104"><span class="lineNum"> 104</span> : : {</span> |
| <span id="L105"><span class="lineNum"> 105</span> :<span class="tlaUNC"> 0 : int rc, ecc_protection;</span></span> |
| <span id="L106"><span class="lineNum"> 106</span> :<span class="tlaUNC"> 0 : struct ecc64 *buffer;</span></span> |
| <span id="L107"><span class="lineNum"> 107</span> :<span class="tlaUNC"> 0 : uint64_t ecc_pos, ecc_start, ecc_diff, ecc_len;</span></span> |
| <span id="L108"><span class="lineNum"> 108</span> : : </span> |
| <span id="L109"><span class="lineNum"> 109</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: 0x%" PRIx64 "\t%p\t0x%" PRIx64 "\n", __func__, pos, buf, len);</span></span> |
| <span id="L110"><span class="lineNum"> 110</span> :<span class="tlaUNC"> 0 : if (!bl || !buf) {</span></span> |
| <span id="L111"><span class="lineNum"> 111</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L112"><span class="lineNum"> 112</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L113"><span class="lineNum"> 113</span> : : }</span> |
| <span id="L114"><span class="lineNum"> 114</span> : : </span> |
| <span id="L115"><span class="lineNum"> 115</span> :<span class="tlaUNC"> 0 : ecc_protection = ecc_protected(bl, pos, len, &ecc_start);</span></span> |
| <span id="L116"><span class="lineNum"> 116</span> : : </span> |
| <span id="L117"><span class="lineNum"> 117</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: 0x%" PRIx64 " for 0x%" PRIx64 " ecc=%s\n",</span></span> |
| <span id="L118"><span class="lineNum"> 118</span> : : __func__, pos, len, ecc_protection ?</span> |
| <span id="L119"><span class="lineNum"> 119</span> : : (ecc_protection == -1 ? "partial" : "yes") : "no");</span> |
| <span id="L120"><span class="lineNum"> 120</span> : : </span> |
| <span id="L121"><span class="lineNum"> 121</span> :<span class="tlaUNC"> 0 : if (!ecc_protection)</span></span> |
| <span id="L122"><span class="lineNum"> 122</span> :<span class="tlaUNC"> 0 : return blocklevel_raw_read(bl, pos, buf, len);</span></span> |
| <span id="L123"><span class="lineNum"> 123</span> : : </span> |
| <span id="L124"><span class="lineNum"> 124</span> : : /*</span> |
| <span id="L125"><span class="lineNum"> 125</span> : : * The region we're reading to has both ecc protection and not.</span> |
| <span id="L126"><span class="lineNum"> 126</span> : : * Perhaps one day in the future blocklevel can cope with this.</span> |
| <span id="L127"><span class="lineNum"> 127</span> : : */</span> |
| <span id="L128"><span class="lineNum"> 128</span> :<span class="tlaUNC"> 0 : if (ecc_protection == -1) {</span></span> |
| <span id="L129"><span class="lineNum"> 129</span> :<span class="tlaUNC"> 0 : FL_ERR("%s: Can't cope with partial ecc\n", __func__);</span></span> |
| <span id="L130"><span class="lineNum"> 130</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L131"><span class="lineNum"> 131</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</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> :<span class="tlaUNC"> 0 : pos = with_ecc_pos(ecc_start, pos);</span></span> |
| <span id="L135"><span class="lineNum"> 135</span> : : </span> |
| <span id="L136"><span class="lineNum"> 136</span> :<span class="tlaUNC"> 0 : ecc_pos = ecc_buffer_align(ecc_start, pos);</span></span> |
| <span id="L137"><span class="lineNum"> 137</span> :<span class="tlaUNC"> 0 : ecc_diff = pos - ecc_pos;</span></span> |
| <span id="L138"><span class="lineNum"> 138</span> :<span class="tlaUNC"> 0 : ecc_len = ecc_buffer_size(len + ecc_diff);</span></span> |
| <span id="L139"><span class="lineNum"> 139</span> : : </span> |
| <span id="L140"><span class="lineNum"> 140</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: adjusted_pos: 0x%" PRIx64 ", ecc_pos: 0x%" PRIx64</span></span> |
| <span id="L141"><span class="lineNum"> 141</span> : : ", ecc_diff: 0x%" PRIx64 ", ecc_len: 0x%" PRIx64 "\n",</span> |
| <span id="L142"><span class="lineNum"> 142</span> : : __func__, pos, ecc_pos, ecc_diff, ecc_len);</span> |
| <span id="L143"><span class="lineNum"> 143</span> :<span class="tlaUNC"> 0 : buffer = malloc(ecc_len);</span></span> |
| <span id="L144"><span class="lineNum"> 144</span> :<span class="tlaUNC"> 0 : if (!buffer) {</span></span> |
| <span id="L145"><span class="lineNum"> 145</span> :<span class="tlaUNC"> 0 : errno = ENOMEM;</span></span> |
| <span id="L146"><span class="lineNum"> 146</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L147"><span class="lineNum"> 147</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L148"><span class="lineNum"> 148</span> : : }</span> |
| <span id="L149"><span class="lineNum"> 149</span> : : </span> |
| <span id="L150"><span class="lineNum"> 150</span> :<span class="tlaUNC"> 0 : rc = blocklevel_raw_read(bl, ecc_pos, buffer, ecc_len);</span></span> |
| <span id="L151"><span class="lineNum"> 151</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L152"><span class="lineNum"> 152</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L153"><span class="lineNum"> 153</span> : : </span> |
| <span id="L154"><span class="lineNum"> 154</span> : : /*</span> |
| <span id="L155"><span class="lineNum"> 155</span> : : * Could optimise and simply call memcpy_from_ecc() if ecc_diff</span> |
| <span id="L156"><span class="lineNum"> 156</span> : : * == 0 but _unaligned checks and bascially does that for us</span> |
| <span id="L157"><span class="lineNum"> 157</span> : : */</span> |
| <span id="L158"><span class="lineNum"> 158</span> :<span class="tlaUNC"> 0 : if (memcpy_from_ecc_unaligned(buf, buffer, len, ecc_diff)) {</span></span> |
| <span id="L159"><span class="lineNum"> 159</span> :<span class="tlaUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L160"><span class="lineNum"> 160</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L161"><span class="lineNum"> 161</span> : : }</span> |
| <span id="L162"><span class="lineNum"> 162</span> : : </span> |
| <span id="L163"><span class="lineNum"> 163</span> :<span class="tlaUNC"> 0 : out:</span></span> |
| <span id="L164"><span class="lineNum"> 164</span> :<span class="tlaUNC"> 0 : free(buffer);</span></span> |
| <span id="L165"><span class="lineNum"> 165</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L166"><span class="lineNum"> 166</span> : : }</span> |
| <span id="L167"><span class="lineNum"> 167</span> : : </span> |
| <span id="L168"><span class="lineNum"> 168</span> :<span class="tlaGNC tlaBgGNC"> 34 : int blocklevel_raw_write(struct blocklevel_device *bl, uint64_t pos,</span></span> |
| <span id="L169"><span class="lineNum"> 169</span> : : const void *buf, uint64_t len)</span> |
| <span id="L170"><span class="lineNum"> 170</span> : : {</span> |
| <span id="L171"><span class="lineNum"> 171</span> :<span class="tlaGNC"> 34 : int rc;</span></span> |
| <span id="L172"><span class="lineNum"> 172</span> : : </span> |
| <span id="L173"><span class="lineNum"> 173</span> :<span class="tlaGNC"> 34 : FL_DBG("%s: 0x%" PRIx64 "\t%p\t0x%" PRIx64 "\n", __func__, pos, buf, len);</span></span> |
| <span id="L174"><span class="lineNum"> 174</span> :<span class="tlaGNC"> 34 : if (!bl || !bl->write || !buf) {</span></span> |
| <span id="L175"><span class="lineNum"> 175</span> :<span class="tlaUNC tlaBgUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L176"><span class="lineNum"> 176</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L177"><span class="lineNum"> 177</span> : : }</span> |
| <span id="L178"><span class="lineNum"> 178</span> : : </span> |
| <span id="L179"><span class="lineNum"> 179</span> :<span class="tlaGNC tlaBgGNC"> 34 : rc = reacquire(bl);</span></span> |
| <span id="L180"><span class="lineNum"> 180</span> :<span class="tlaGNC"> 34 : if (rc)</span></span> |
| <span id="L181"><span class="lineNum"> 181</span> : : return rc;</span> |
| <span id="L182"><span class="lineNum"> 182</span> : : </span> |
| <span id="L183"><span class="lineNum"> 183</span> :<span class="tlaGNC"> 34 : rc = bl->write(bl, pos, buf, len);</span></span> |
| <span id="L184"><span class="lineNum"> 184</span> : : </span> |
| <span id="L185"><span class="lineNum"> 185</span> :<span class="tlaGNC"> 34 : release(bl);</span></span> |
| <span id="L186"><span class="lineNum"> 186</span> : : </span> |
| <span id="L187"><span class="lineNum"> 187</span> :<span class="tlaGNC"> 34 : return rc;</span></span> |
| <span id="L188"><span class="lineNum"> 188</span> : : }</span> |
| <span id="L189"><span class="lineNum"> 189</span> : : </span> |
| <span id="L190"><span class="lineNum"> 190</span> :<span class="tlaGNC"> 34 : int blocklevel_write(struct blocklevel_device *bl, uint64_t pos, const void *buf,</span></span> |
| <span id="L191"><span class="lineNum"> 191</span> : : uint64_t len)</span> |
| <span id="L192"><span class="lineNum"> 192</span> : : {</span> |
| <span id="L193"><span class="lineNum"> 193</span> :<span class="tlaGNC"> 34 : int rc, ecc_protection;</span></span> |
| <span id="L194"><span class="lineNum"> 194</span> :<span class="tlaGNC"> 34 : struct ecc64 *buffer;</span></span> |
| <span id="L195"><span class="lineNum"> 195</span> :<span class="tlaGNC"> 34 : uint64_t ecc_len;</span></span> |
| <span id="L196"><span class="lineNum"> 196</span> :<span class="tlaGNC"> 34 : uint64_t ecc_start, ecc_pos, ecc_diff;</span></span> |
| <span id="L197"><span class="lineNum"> 197</span> : : </span> |
| <span id="L198"><span class="lineNum"> 198</span> :<span class="tlaGNC"> 34 : FL_DBG("%s: 0x%" PRIx64 "\t%p\t0x%" PRIx64 "\n", __func__, pos, buf, len);</span></span> |
| <span id="L199"><span class="lineNum"> 199</span> :<span class="tlaGNC"> 34 : if (!bl || !buf) {</span></span> |
| <span id="L200"><span class="lineNum"> 200</span> :<span class="tlaUNC tlaBgUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L201"><span class="lineNum"> 201</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L202"><span class="lineNum"> 202</span> : : }</span> |
| <span id="L203"><span class="lineNum"> 203</span> : : </span> |
| <span id="L204"><span class="lineNum"> 204</span> :<span class="tlaGNC tlaBgGNC"> 34 : ecc_protection = ecc_protected(bl, pos, len, &ecc_start);</span></span> |
| <span id="L205"><span class="lineNum"> 205</span> : : </span> |
| <span id="L206"><span class="lineNum"> 206</span> :<span class="tlaGNC"> 34 : FL_DBG("%s: 0x%" PRIx64 " for 0x%" PRIx64 " ecc=%s\n",</span></span> |
| <span id="L207"><span class="lineNum"> 207</span> : : __func__, pos, len, ecc_protection ?</span> |
| <span id="L208"><span class="lineNum"> 208</span> : : (ecc_protection == -1 ? "partial" : "yes") : "no");</span> |
| <span id="L209"><span class="lineNum"> 209</span> : : </span> |
| <span id="L210"><span class="lineNum"> 210</span> :<span class="tlaGNC"> 34 : if (!ecc_protection)</span></span> |
| <span id="L211"><span class="lineNum"> 211</span> :<span class="tlaGNC"> 14 : return blocklevel_raw_write(bl, pos, buf, len);</span></span> |
| <span id="L212"><span class="lineNum"> 212</span> : : </span> |
| <span id="L213"><span class="lineNum"> 213</span> : : /*</span> |
| <span id="L214"><span class="lineNum"> 214</span> : : * The region we're writing to has both ecc protection and not.</span> |
| <span id="L215"><span class="lineNum"> 215</span> : : * Perhaps one day in the future blocklevel can cope with this.</span> |
| <span id="L216"><span class="lineNum"> 216</span> : : */</span> |
| <span id="L217"><span class="lineNum"> 217</span> :<span class="tlaGNC"> 20 : if (ecc_protection == -1) {</span></span> |
| <span id="L218"><span class="lineNum"> 218</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("%s: Can't cope with partial ecc\n", __func__);</span></span> |
| <span id="L219"><span class="lineNum"> 219</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L220"><span class="lineNum"> 220</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L221"><span class="lineNum"> 221</span> : : }</span> |
| <span id="L222"><span class="lineNum"> 222</span> : : </span> |
| <span id="L223"><span class="lineNum"> 223</span> :<span class="tlaGNC tlaBgGNC"> 20 : pos = with_ecc_pos(ecc_start, pos);</span></span> |
| <span id="L224"><span class="lineNum"> 224</span> : : </span> |
| <span id="L225"><span class="lineNum"> 225</span> :<span class="tlaGNC"> 20 : ecc_pos = ecc_buffer_align(ecc_start, pos);</span></span> |
| <span id="L226"><span class="lineNum"> 226</span> :<span class="tlaGNC"> 20 : ecc_diff = pos - ecc_pos;</span></span> |
| <span id="L227"><span class="lineNum"> 227</span> :<span class="tlaGNC"> 20 : ecc_len = ecc_buffer_size(len + ecc_diff);</span></span> |
| <span id="L228"><span class="lineNum"> 228</span> : : </span> |
| <span id="L229"><span class="lineNum"> 229</span> :<span class="tlaGNC"> 20 : FL_DBG("%s: adjusted_pos: 0x%" PRIx64 ", ecc_pos: 0x%" PRIx64</span></span> |
| <span id="L230"><span class="lineNum"> 230</span> : : ", ecc_diff: 0x%" PRIx64 ", ecc_len: 0x%" PRIx64 "\n",</span> |
| <span id="L231"><span class="lineNum"> 231</span> : : __func__, pos, ecc_pos, ecc_diff, ecc_len);</span> |
| <span id="L232"><span class="lineNum"> 232</span> : : </span> |
| <span id="L233"><span class="lineNum"> 233</span> :<span class="tlaGNC"> 20 : buffer = malloc(ecc_len);</span></span> |
| <span id="L234"><span class="lineNum"> 234</span> :<span class="tlaGNC"> 20 : if (!buffer) {</span></span> |
| <span id="L235"><span class="lineNum"> 235</span> :<span class="tlaUNC tlaBgUNC"> 0 : errno = ENOMEM;</span></span> |
| <span id="L236"><span class="lineNum"> 236</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L237"><span class="lineNum"> 237</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L238"><span class="lineNum"> 238</span> : : }</span> |
| <span id="L239"><span class="lineNum"> 239</span> : : </span> |
| <span id="L240"><span class="lineNum"> 240</span> :<span class="tlaGNC tlaBgGNC"> 20 : if (ecc_diff) {</span></span> |
| <span id="L241"><span class="lineNum"> 241</span> :<span class="tlaUNC tlaBgUNC"> 0 : uint64_t start_chunk = ecc_diff;</span></span> |
| <span id="L242"><span class="lineNum"> 242</span> :<span class="tlaUNC"> 0 : uint64_t end_chunk = BYTES_PER_ECC - ecc_diff;</span></span> |
| <span id="L243"><span class="lineNum"> 243</span> :<span class="tlaUNC"> 0 : uint64_t end_len = ecc_len - end_chunk;</span></span> |
| <span id="L244"><span class="lineNum"> 244</span> : : </span> |
| <span id="L245"><span class="lineNum"> 245</span> : : /*</span> |
| <span id="L246"><span class="lineNum"> 246</span> : : * Read the start bytes that memcpy_to_ecc_unaligned() will need</span> |
| <span id="L247"><span class="lineNum"> 247</span> : : * to calculate the first ecc byte</span> |
| <span id="L248"><span class="lineNum"> 248</span> : : */</span> |
| <span id="L249"><span class="lineNum"> 249</span> :<span class="tlaUNC"> 0 : rc = blocklevel_raw_read(bl, ecc_pos, buffer, start_chunk);</span></span> |
| <span id="L250"><span class="lineNum"> 250</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L251"><span class="lineNum"> 251</span> :<span class="tlaUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L252"><span class="lineNum"> 252</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L253"><span class="lineNum"> 253</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L254"><span class="lineNum"> 254</span> : : }</span> |
| <span id="L255"><span class="lineNum"> 255</span> : : </span> |
| <span id="L256"><span class="lineNum"> 256</span> : : /*</span> |
| <span id="L257"><span class="lineNum"> 257</span> : : * Read the end bytes that memcpy_to_ecc_unaligned() will need</span> |
| <span id="L258"><span class="lineNum"> 258</span> : : * to calculate the last ecc byte</span> |
| <span id="L259"><span class="lineNum"> 259</span> : : */</span> |
| <span id="L260"><span class="lineNum"> 260</span> :<span class="tlaUNC"> 0 : rc = blocklevel_raw_read(bl, ecc_pos + end_len, ((char *)buffer) + end_len,</span></span> |
| <span id="L261"><span class="lineNum"> 261</span> : : end_chunk);</span> |
| <span id="L262"><span class="lineNum"> 262</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L263"><span class="lineNum"> 263</span> :<span class="tlaUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L264"><span class="lineNum"> 264</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L265"><span class="lineNum"> 265</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L266"><span class="lineNum"> 266</span> : : }</span> |
| <span id="L267"><span class="lineNum"> 267</span> : : </span> |
| <span id="L268"><span class="lineNum"> 268</span> :<span class="tlaUNC"> 0 : if (memcpy_to_ecc_unaligned(buffer, buf, len, ecc_diff)) {</span></span> |
| <span id="L269"><span class="lineNum"> 269</span> :<span class="tlaUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L270"><span class="lineNum"> 270</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L271"><span class="lineNum"> 271</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L272"><span class="lineNum"> 272</span> : : }</span> |
| <span id="L273"><span class="lineNum"> 273</span> : : } else {</span> |
| <span id="L274"><span class="lineNum"> 274</span> :<span class="tlaGNC tlaBgGNC"> 20 : if (memcpy_to_ecc(buffer, buf, len)) {</span></span> |
| <span id="L275"><span class="lineNum"> 275</span> :<span class="tlaUNC tlaBgUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L276"><span class="lineNum"> 276</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L277"><span class="lineNum"> 277</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L278"><span class="lineNum"> 278</span> : : }</span> |
| <span id="L279"><span class="lineNum"> 279</span> : : }</span> |
| <span id="L280"><span class="lineNum"> 280</span> :<span class="tlaGNC tlaBgGNC"> 20 : rc = blocklevel_raw_write(bl, pos, buffer, ecc_len);</span></span> |
| <span id="L281"><span class="lineNum"> 281</span> : : </span> |
| <span id="L282"><span class="lineNum"> 282</span> :<span class="tlaGNC"> 20 : out:</span></span> |
| <span id="L283"><span class="lineNum"> 283</span> :<span class="tlaGNC"> 20 : free(buffer);</span></span> |
| <span id="L284"><span class="lineNum"> 284</span> :<span class="tlaGNC"> 20 : return rc;</span></span> |
| <span id="L285"><span class="lineNum"> 285</span> : : }</span> |
| <span id="L286"><span class="lineNum"> 286</span> : : </span> |
| <span id="L287"><span class="lineNum"> 287</span> :<span class="tlaGNC"> 12 : int blocklevel_erase(struct blocklevel_device *bl, uint64_t pos, uint64_t len)</span></span> |
| <span id="L288"><span class="lineNum"> 288</span> : : {</span> |
| <span id="L289"><span class="lineNum"> 289</span> :<span class="tlaGNC"> 12 : int rc;</span></span> |
| <span id="L290"><span class="lineNum"> 290</span> :<span class="tlaGNC"> 12 : if (!bl || !bl->erase) {</span></span> |
| <span id="L291"><span class="lineNum"> 291</span> :<span class="tlaUNC tlaBgUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L292"><span class="lineNum"> 292</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</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"> 12 : FL_DBG("%s: 0x%" PRIx64 "\t0x%" PRIx64 "\n", __func__, pos, len);</span></span> |
| <span id="L296"><span class="lineNum"> 296</span> : : </span> |
| <span id="L297"><span class="lineNum"> 297</span> : : /* Programmer may be making a horrible mistake without knowing it */</span> |
| <span id="L298"><span class="lineNum"> 298</span> :<span class="tlaGNC"> 12 : if (pos & bl->erase_mask) {</span></span> |
| <span id="L299"><span class="lineNum"> 299</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("blocklevel_erase: pos (0x%"PRIx64") is not erase block (0x%08x) aligned\n",</span></span> |
| <span id="L300"><span class="lineNum"> 300</span> : : pos, bl->erase_mask + 1);</span> |
| <span id="L301"><span class="lineNum"> 301</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_ERASE_BOUNDARY;</span></span> |
| <span id="L302"><span class="lineNum"> 302</span> : : }</span> |
| <span id="L303"><span class="lineNum"> 303</span> : : </span> |
| <span id="L304"><span class="lineNum"> 304</span> :<span class="tlaGNC tlaBgGNC"> 12 : if (len & bl->erase_mask) {</span></span> |
| <span id="L305"><span class="lineNum"> 305</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_ERR("blocklevel_erase: len (0x%"PRIx64") is not erase block (0x%08x) aligned\n",</span></span> |
| <span id="L306"><span class="lineNum"> 306</span> : : len, bl->erase_mask + 1);</span> |
| <span id="L307"><span class="lineNum"> 307</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_ERASE_BOUNDARY;</span></span> |
| <span id="L308"><span class="lineNum"> 308</span> : : }</span> |
| <span id="L309"><span class="lineNum"> 309</span> : : </span> |
| <span id="L310"><span class="lineNum"> 310</span> :<span class="tlaGNC tlaBgGNC"> 12 : rc = reacquire(bl);</span></span> |
| <span id="L311"><span class="lineNum"> 311</span> :<span class="tlaGNC"> 12 : if (rc)</span></span> |
| <span id="L312"><span class="lineNum"> 312</span> : : return rc;</span> |
| <span id="L313"><span class="lineNum"> 313</span> : : </span> |
| <span id="L314"><span class="lineNum"> 314</span> :<span class="tlaGNC"> 12 : rc = bl->erase(bl, pos, len);</span></span> |
| <span id="L315"><span class="lineNum"> 315</span> : : </span> |
| <span id="L316"><span class="lineNum"> 316</span> :<span class="tlaGNC"> 12 : release(bl);</span></span> |
| <span id="L317"><span class="lineNum"> 317</span> : : </span> |
| <span id="L318"><span class="lineNum"> 318</span> :<span class="tlaGNC"> 12 : return rc;</span></span> |
| <span id="L319"><span class="lineNum"> 319</span> : : }</span> |
| <span id="L320"><span class="lineNum"> 320</span> : : </span> |
| <span id="L321"><span class="lineNum"> 321</span> :<span class="tlaUNC tlaBgUNC"> 0 : int blocklevel_get_info(struct blocklevel_device *bl, const char **name, uint64_t *total_size,</span></span> |
| <span id="L322"><span class="lineNum"> 322</span> : : uint32_t *erase_granule)</span> |
| <span id="L323"><span class="lineNum"> 323</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> :<span class="tlaUNC"> 0 : if (!bl || !bl->get_info) {</span></span> |
| <span id="L327"><span class="lineNum"> 327</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L328"><span class="lineNum"> 328</span> :<span class="tlaUNC"> 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> |
| <span id="L331"><span class="lineNum"> 331</span> :<span class="tlaUNC"> 0 : rc = reacquire(bl);</span></span> |
| <span id="L332"><span class="lineNum"> 332</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L333"><span class="lineNum"> 333</span> : : return rc;</span> |
| <span id="L334"><span class="lineNum"> 334</span> : : </span> |
| <span id="L335"><span class="lineNum"> 335</span> :<span class="tlaUNC"> 0 : rc = bl->get_info(bl, name, total_size, erase_granule);</span></span> |
| <span id="L336"><span class="lineNum"> 336</span> : : </span> |
| <span id="L337"><span class="lineNum"> 337</span> : : /* Check the validity of what we are being told */</span> |
| <span id="L338"><span class="lineNum"> 338</span> :<span class="tlaUNC"> 0 : if (erase_granule && *erase_granule != bl->erase_mask + 1)</span></span> |
| <span id="L339"><span class="lineNum"> 339</span> :<span class="tlaUNC"> 0 : FL_ERR("blocklevel_get_info: WARNING: erase_granule (0x%08x) and erase_mask"</span></span> |
| <span id="L340"><span class="lineNum"> 340</span> : : " (0x%08x) don't match\n", *erase_granule, bl->erase_mask + 1);</span> |
| <span id="L341"><span class="lineNum"> 341</span> : : </span> |
| <span id="L342"><span class="lineNum"> 342</span> :<span class="tlaUNC"> 0 : release(bl);</span></span> |
| <span id="L343"><span class="lineNum"> 343</span> : : </span> |
| <span id="L344"><span class="lineNum"> 344</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L345"><span class="lineNum"> 345</span> : : }</span> |
| <span id="L346"><span class="lineNum"> 346</span> : : </span> |
| <span id="L347"><span class="lineNum"> 347</span> : : /*</span> |
| <span id="L348"><span class="lineNum"> 348</span> : : * Compare flash and memory to determine if:</span> |
| <span id="L349"><span class="lineNum"> 349</span> : : * a) Erase must happen before write</span> |
| <span id="L350"><span class="lineNum"> 350</span> : : * b) Flash and memory are identical</span> |
| <span id="L351"><span class="lineNum"> 351</span> : : * c) Flash can simply be written to</span> |
| <span id="L352"><span class="lineNum"> 352</span> : : *</span> |
| <span id="L353"><span class="lineNum"> 353</span> : : * returns -1 for a</span> |
| <span id="L354"><span class="lineNum"> 354</span> : : * returns 0 for b</span> |
| <span id="L355"><span class="lineNum"> 355</span> : : * returns 1 for c</span> |
| <span id="L356"><span class="lineNum"> 356</span> : : */</span> |
| <span id="L357"><span class="lineNum"> 357</span> :<span class="tlaUNC"> 0 : static int blocklevel_flashcmp(const void *flash_buf, const void *mem_buf, uint64_t len)</span></span> |
| <span id="L358"><span class="lineNum"> 358</span> : : {</span> |
| <span id="L359"><span class="lineNum"> 359</span> :<span class="tlaUNC"> 0 : uint64_t i;</span></span> |
| <span id="L360"><span class="lineNum"> 360</span> :<span class="tlaUNC"> 0 : int same = true;</span></span> |
| <span id="L361"><span class="lineNum"> 361</span> :<span class="tlaUNC"> 0 : const uint8_t *f_buf, *m_buf;</span></span> |
| <span id="L362"><span class="lineNum"> 362</span> : : </span> |
| <span id="L363"><span class="lineNum"> 363</span> :<span class="tlaUNC"> 0 : f_buf = flash_buf;</span></span> |
| <span id="L364"><span class="lineNum"> 364</span> :<span class="tlaUNC"> 0 : m_buf = mem_buf;</span></span> |
| <span id="L365"><span class="lineNum"> 365</span> : : </span> |
| <span id="L366"><span class="lineNum"> 366</span> :<span class="tlaUNC"> 0 : for (i = 0; i < len; i++) {</span></span> |
| <span id="L367"><span class="lineNum"> 367</span> :<span class="tlaUNC"> 0 : if (m_buf[i] & ~f_buf[i])</span></span> |
| <span id="L368"><span class="lineNum"> 368</span> : : return -1;</span> |
| <span id="L369"><span class="lineNum"> 369</span> :<span class="tlaUNC"> 0 : if (same && (m_buf[i] != f_buf[i]))</span></span> |
| <span id="L370"><span class="lineNum"> 370</span> :<span class="tlaUNC"> 0 : same = false;</span></span> |
| <span id="L371"><span class="lineNum"> 371</span> : : }</span> |
| <span id="L372"><span class="lineNum"> 372</span> : : </span> |
| <span id="L373"><span class="lineNum"> 373</span> :<span class="tlaUNC"> 0 : return same ? 0 : 1;</span></span> |
| <span id="L374"><span class="lineNum"> 374</span> : : }</span> |
| <span id="L375"><span class="lineNum"> 375</span> : : </span> |
| <span id="L376"><span class="lineNum"> 376</span> :<span class="tlaUNC"> 0 : int blocklevel_smart_erase(struct blocklevel_device *bl, uint64_t pos, uint64_t len)</span></span> |
| <span id="L377"><span class="lineNum"> 377</span> : : {</span> |
| <span id="L378"><span class="lineNum"> 378</span> :<span class="tlaUNC"> 0 : uint64_t block_size;</span></span> |
| <span id="L379"><span class="lineNum"> 379</span> :<span class="tlaUNC"> 0 : void *erase_buf;</span></span> |
| <span id="L380"><span class="lineNum"> 380</span> :<span class="tlaUNC"> 0 : int rc;</span></span> |
| <span id="L381"><span class="lineNum"> 381</span> : : </span> |
| <span id="L382"><span class="lineNum"> 382</span> :<span class="tlaUNC"> 0 : if (!bl) {</span></span> |
| <span id="L383"><span class="lineNum"> 383</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L384"><span class="lineNum"> 384</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L385"><span class="lineNum"> 385</span> : : }</span> |
| <span id="L386"><span class="lineNum"> 386</span> : : </span> |
| <span id="L387"><span class="lineNum"> 387</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: 0x%" PRIx64 "\t0x%" PRIx64 "\n", __func__, pos, len);</span></span> |
| <span id="L388"><span class="lineNum"> 388</span> : : </span> |
| <span id="L389"><span class="lineNum"> 389</span> : : /* Nothing smart needs to be done, pos and len are aligned */</span> |
| <span id="L390"><span class="lineNum"> 390</span> :<span class="tlaUNC"> 0 : if ((pos & bl->erase_mask) == 0 && (len & bl->erase_mask) == 0) {</span></span> |
| <span id="L391"><span class="lineNum"> 391</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: Skipping smarts everything is aligned 0x%" PRIx64 " 0x%" PRIx64</span></span> |
| <span id="L392"><span class="lineNum"> 392</span> : : "to 0x%08x\n", __func__, pos, len, bl->erase_mask);</span> |
| <span id="L393"><span class="lineNum"> 393</span> :<span class="tlaUNC"> 0 : return blocklevel_erase(bl, pos, len);</span></span> |
| <span id="L394"><span class="lineNum"> 394</span> : : }</span> |
| <span id="L395"><span class="lineNum"> 395</span> :<span class="tlaUNC"> 0 : block_size = bl->erase_mask + 1;</span></span> |
| <span id="L396"><span class="lineNum"> 396</span> :<span class="tlaUNC"> 0 : erase_buf = malloc(block_size);</span></span> |
| <span id="L397"><span class="lineNum"> 397</span> :<span class="tlaUNC"> 0 : if (!erase_buf) {</span></span> |
| <span id="L398"><span class="lineNum"> 398</span> :<span class="tlaUNC"> 0 : errno = ENOMEM;</span></span> |
| <span id="L399"><span class="lineNum"> 399</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L400"><span class="lineNum"> 400</span> : : }</span> |
| <span id="L401"><span class="lineNum"> 401</span> : : </span> |
| <span id="L402"><span class="lineNum"> 402</span> :<span class="tlaUNC"> 0 : rc = reacquire(bl);</span></span> |
| <span id="L403"><span class="lineNum"> 403</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L404"><span class="lineNum"> 404</span> :<span class="tlaUNC"> 0 : free(erase_buf);</span></span> |
| <span id="L405"><span class="lineNum"> 405</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L406"><span class="lineNum"> 406</span> : : }</span> |
| <span id="L407"><span class="lineNum"> 407</span> : : </span> |
| <span id="L408"><span class="lineNum"> 408</span> :<span class="tlaUNC"> 0 : if (pos & bl->erase_mask) {</span></span> |
| <span id="L409"><span class="lineNum"> 409</span> : : /*</span> |
| <span id="L410"><span class="lineNum"> 410</span> : : * base_pos and base_len are the values in the first erase</span> |
| <span id="L411"><span class="lineNum"> 411</span> : : * block that we need to preserve: the region up to pos.</span> |
| <span id="L412"><span class="lineNum"> 412</span> : : */</span> |
| <span id="L413"><span class="lineNum"> 413</span> :<span class="tlaUNC"> 0 : uint64_t base_pos = pos & ~(bl->erase_mask);</span></span> |
| <span id="L414"><span class="lineNum"> 414</span> :<span class="tlaUNC"> 0 : uint64_t base_len = pos - base_pos;</span></span> |
| <span id="L415"><span class="lineNum"> 415</span> : : </span> |
| <span id="L416"><span class="lineNum"> 416</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: preserving 0x%" PRIx64 "..0x%" PRIx64 "\n",</span></span> |
| <span id="L417"><span class="lineNum"> 417</span> : : __func__, base_pos, base_pos + base_len);</span> |
| <span id="L418"><span class="lineNum"> 418</span> : : </span> |
| <span id="L419"><span class="lineNum"> 419</span> : : /*</span> |
| <span id="L420"><span class="lineNum"> 420</span> : : * Read the entire block in case this is the ONLY block we're</span> |
| <span id="L421"><span class="lineNum"> 421</span> : : * modifying, we may need the end chunk of it later</span> |
| <span id="L422"><span class="lineNum"> 422</span> : : */</span> |
| <span id="L423"><span class="lineNum"> 423</span> :<span class="tlaUNC"> 0 : rc = bl->read(bl, base_pos, erase_buf, block_size);</span></span> |
| <span id="L424"><span class="lineNum"> 424</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L425"><span class="lineNum"> 425</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L426"><span class="lineNum"> 426</span> : : </span> |
| <span id="L427"><span class="lineNum"> 427</span> :<span class="tlaUNC"> 0 : rc = bl->erase(bl, base_pos, block_size);</span></span> |
| <span id="L428"><span class="lineNum"> 428</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L429"><span class="lineNum"> 429</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L430"><span class="lineNum"> 430</span> : : </span> |
| <span id="L431"><span class="lineNum"> 431</span> :<span class="tlaUNC"> 0 : rc = bl->write(bl, base_pos, erase_buf, base_len);</span></span> |
| <span id="L432"><span class="lineNum"> 432</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L433"><span class="lineNum"> 433</span> :<span class="tlaUNC"> 0 : goto out;</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> : : * The requested erase fits entirely into this erase block and</span> |
| <span id="L437"><span class="lineNum"> 437</span> : : * so we need to write back the chunk at the end of the block</span> |
| <span id="L438"><span class="lineNum"> 438</span> : : */</span> |
| <span id="L439"><span class="lineNum"> 439</span> :<span class="tlaUNC"> 0 : if (base_pos + base_len + len < base_pos + block_size) {</span></span> |
| <span id="L440"><span class="lineNum"> 440</span> :<span class="tlaUNC"> 0 : rc = bl->write(bl, pos + len, erase_buf + base_len + len,</span></span> |
| <span id="L441"><span class="lineNum"> 441</span> :<span class="tlaUNC"> 0 : block_size - base_len - len);</span></span> |
| <span id="L442"><span class="lineNum"> 442</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: Early exit, everything was in one erase block\n",</span></span> |
| <span id="L443"><span class="lineNum"> 443</span> : : __func__);</span> |
| <span id="L444"><span class="lineNum"> 444</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L445"><span class="lineNum"> 445</span> : : }</span> |
| <span id="L446"><span class="lineNum"> 446</span> : : </span> |
| <span id="L447"><span class="lineNum"> 447</span> :<span class="tlaUNC"> 0 : pos += block_size - base_len;</span></span> |
| <span id="L448"><span class="lineNum"> 448</span> :<span class="tlaUNC"> 0 : len -= block_size - base_len;</span></span> |
| <span id="L449"><span class="lineNum"> 449</span> : : }</span> |
| <span id="L450"><span class="lineNum"> 450</span> : : </span> |
| <span id="L451"><span class="lineNum"> 451</span> : : /* Now we should be aligned, best to double check */</span> |
| <span id="L452"><span class="lineNum"> 452</span> :<span class="tlaUNC"> 0 : if (pos & bl->erase_mask) {</span></span> |
| <span id="L453"><span class="lineNum"> 453</span> :<span class="tlaUNC"> 0 : FL_DBG("%s:pos 0x%" PRIx64 " isn't erase_mask 0x%08x aligned\n",</span></span> |
| <span id="L454"><span class="lineNum"> 454</span> : : __func__, pos, bl->erase_mask);</span> |
| <span id="L455"><span class="lineNum"> 455</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L456"><span class="lineNum"> 456</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L457"><span class="lineNum"> 457</span> : : }</span> |
| <span id="L458"><span class="lineNum"> 458</span> : : </span> |
| <span id="L459"><span class="lineNum"> 459</span> :<span class="tlaUNC"> 0 : if (len & ~(bl->erase_mask)) {</span></span> |
| <span id="L460"><span class="lineNum"> 460</span> :<span class="tlaUNC"> 0 : rc = bl->erase(bl, pos, len & ~(bl->erase_mask));</span></span> |
| <span id="L461"><span class="lineNum"> 461</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L462"><span class="lineNum"> 462</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L463"><span class="lineNum"> 463</span> : : </span> |
| <span id="L464"><span class="lineNum"> 464</span> :<span class="tlaUNC"> 0 : pos += len & ~(bl->erase_mask);</span></span> |
| <span id="L465"><span class="lineNum"> 465</span> :<span class="tlaUNC"> 0 : len -= len & ~(bl->erase_mask);</span></span> |
| <span id="L466"><span class="lineNum"> 466</span> : : }</span> |
| <span id="L467"><span class="lineNum"> 467</span> : : </span> |
| <span id="L468"><span class="lineNum"> 468</span> : : /* Length should be less than a block now */</span> |
| <span id="L469"><span class="lineNum"> 469</span> :<span class="tlaUNC"> 0 : if (len > block_size) {</span></span> |
| <span id="L470"><span class="lineNum"> 470</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: len 0x%" PRIx64 " is still exceeds block_size 0x%" PRIx64 "\n",</span></span> |
| <span id="L471"><span class="lineNum"> 471</span> : : __func__, len, block_size);</span> |
| <span id="L472"><span class="lineNum"> 472</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L473"><span class="lineNum"> 473</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L474"><span class="lineNum"> 474</span> : : }</span> |
| <span id="L475"><span class="lineNum"> 475</span> : : </span> |
| <span id="L476"><span class="lineNum"> 476</span> :<span class="tlaUNC"> 0 : if (len & bl->erase_mask) {</span></span> |
| <span id="L477"><span class="lineNum"> 477</span> : : /*</span> |
| <span id="L478"><span class="lineNum"> 478</span> : : * top_pos is the first byte that must be preserved and</span> |
| <span id="L479"><span class="lineNum"> 479</span> : : * top_len is the length from top_pos to the end of the erase</span> |
| <span id="L480"><span class="lineNum"> 480</span> : : * block: the region that must be preserved</span> |
| <span id="L481"><span class="lineNum"> 481</span> : : */</span> |
| <span id="L482"><span class="lineNum"> 482</span> :<span class="tlaUNC"> 0 : uint64_t top_pos = pos + len;</span></span> |
| <span id="L483"><span class="lineNum"> 483</span> :<span class="tlaUNC"> 0 : uint64_t top_len = block_size - len;</span></span> |
| <span id="L484"><span class="lineNum"> 484</span> : : </span> |
| <span id="L485"><span class="lineNum"> 485</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: preserving 0x%" PRIx64 "..0x%" PRIx64 "\n",</span></span> |
| <span id="L486"><span class="lineNum"> 486</span> : : __func__, top_pos, top_pos + top_len);</span> |
| <span id="L487"><span class="lineNum"> 487</span> : : </span> |
| <span id="L488"><span class="lineNum"> 488</span> :<span class="tlaUNC"> 0 : rc = bl->read(bl, top_pos, erase_buf, top_len);</span></span> |
| <span id="L489"><span class="lineNum"> 489</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L490"><span class="lineNum"> 490</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L491"><span class="lineNum"> 491</span> : : </span> |
| <span id="L492"><span class="lineNum"> 492</span> :<span class="tlaUNC"> 0 : rc = bl->erase(bl, pos, block_size);</span></span> |
| <span id="L493"><span class="lineNum"> 493</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L494"><span class="lineNum"> 494</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L495"><span class="lineNum"> 495</span> : : </span> |
| <span id="L496"><span class="lineNum"> 496</span> :<span class="tlaUNC"> 0 : rc = bl->write(bl, top_pos, erase_buf, top_len);</span></span> |
| <span id="L497"><span class="lineNum"> 497</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L498"><span class="lineNum"> 498</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L499"><span class="lineNum"> 499</span> : : }</span> |
| <span id="L500"><span class="lineNum"> 500</span> : : </span> |
| <span id="L501"><span class="lineNum"> 501</span> :<span class="tlaUNC"> 0 : out:</span></span> |
| <span id="L502"><span class="lineNum"> 502</span> :<span class="tlaUNC"> 0 : free(erase_buf);</span></span> |
| <span id="L503"><span class="lineNum"> 503</span> :<span class="tlaUNC"> 0 : release(bl);</span></span> |
| <span id="L504"><span class="lineNum"> 504</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L505"><span class="lineNum"> 505</span> : : }</span> |
| <span id="L506"><span class="lineNum"> 506</span> : : </span> |
| <span id="L507"><span class="lineNum"> 507</span> :<span class="tlaUNC"> 0 : int blocklevel_smart_write(struct blocklevel_device *bl, uint64_t pos, const void *buf, uint64_t len)</span></span> |
| <span id="L508"><span class="lineNum"> 508</span> : : {</span> |
| <span id="L509"><span class="lineNum"> 509</span> :<span class="tlaUNC"> 0 : void *ecc_buf = NULL;</span></span> |
| <span id="L510"><span class="lineNum"> 510</span> :<span class="tlaUNC"> 0 : uint64_t ecc_start;</span></span> |
| <span id="L511"><span class="lineNum"> 511</span> :<span class="tlaUNC"> 0 : int ecc_protection;</span></span> |
| <span id="L512"><span class="lineNum"> 512</span> : : </span> |
| <span id="L513"><span class="lineNum"> 513</span> :<span class="tlaUNC"> 0 : void *erase_buf = NULL;</span></span> |
| <span id="L514"><span class="lineNum"> 514</span> :<span class="tlaUNC"> 0 : uint32_t erase_size;</span></span> |
| <span id="L515"><span class="lineNum"> 515</span> : : </span> |
| <span id="L516"><span class="lineNum"> 516</span> :<span class="tlaUNC"> 0 : const void *write_buf;</span></span> |
| <span id="L517"><span class="lineNum"> 517</span> :<span class="tlaUNC"> 0 : uint64_t write_len;</span></span> |
| <span id="L518"><span class="lineNum"> 518</span> :<span class="tlaUNC"> 0 : uint64_t write_pos;</span></span> |
| <span id="L519"><span class="lineNum"> 519</span> : : </span> |
| <span id="L520"><span class="lineNum"> 520</span> :<span class="tlaUNC"> 0 : int rc = 0;</span></span> |
| <span id="L521"><span class="lineNum"> 521</span> : : </span> |
| <span id="L522"><span class="lineNum"> 522</span> :<span class="tlaUNC"> 0 : if (!buf || !bl) {</span></span> |
| <span id="L523"><span class="lineNum"> 523</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L524"><span class="lineNum"> 524</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L525"><span class="lineNum"> 525</span> : : }</span> |
| <span id="L526"><span class="lineNum"> 526</span> : : </span> |
| <span id="L527"><span class="lineNum"> 527</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: 0x%" PRIx64 "\t0x%" PRIx64 "\n", __func__, pos, len);</span></span> |
| <span id="L528"><span class="lineNum"> 528</span> : : </span> |
| <span id="L529"><span class="lineNum"> 529</span> :<span class="tlaUNC"> 0 : if (!(bl->flags & WRITE_NEED_ERASE)) {</span></span> |
| <span id="L530"><span class="lineNum"> 530</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: backend doesn't need erase\n", __func__);</span></span> |
| <span id="L531"><span class="lineNum"> 531</span> :<span class="tlaUNC"> 0 : return blocklevel_write(bl, pos, buf, len);</span></span> |
| <span id="L532"><span class="lineNum"> 532</span> : : }</span> |
| <span id="L533"><span class="lineNum"> 533</span> : : </span> |
| <span id="L534"><span class="lineNum"> 534</span> :<span class="tlaUNC"> 0 : rc = blocklevel_get_info(bl, NULL, NULL, &erase_size);</span></span> |
| <span id="L535"><span class="lineNum"> 535</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L536"><span class="lineNum"> 536</span> : : return rc;</span> |
| <span id="L537"><span class="lineNum"> 537</span> : : </span> |
| <span id="L538"><span class="lineNum"> 538</span> :<span class="tlaUNC"> 0 : ecc_protection = ecc_protected(bl, pos, len, &ecc_start);</span></span> |
| <span id="L539"><span class="lineNum"> 539</span> :<span class="tlaUNC"> 0 : if (ecc_protection == -1) {</span></span> |
| <span id="L540"><span class="lineNum"> 540</span> :<span class="tlaUNC"> 0 : FL_ERR("%s: Can't cope with partial ecc\n", __func__);</span></span> |
| <span id="L541"><span class="lineNum"> 541</span> :<span class="tlaUNC"> 0 : errno = EINVAL;</span></span> |
| <span id="L542"><span class="lineNum"> 542</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_PARM_ERROR;</span></span> |
| <span id="L543"><span class="lineNum"> 543</span> : : }</span> |
| <span id="L544"><span class="lineNum"> 544</span> : : </span> |
| <span id="L545"><span class="lineNum"> 545</span> :<span class="tlaUNC"> 0 : if (ecc_protection) {</span></span> |
| <span id="L546"><span class="lineNum"> 546</span> :<span class="tlaUNC"> 0 : uint64_t ecc_pos, ecc_align, ecc_diff, ecc_len;</span></span> |
| <span id="L547"><span class="lineNum"> 547</span> : : </span> |
| <span id="L548"><span class="lineNum"> 548</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: region has ECC\n", __func__);</span></span> |
| <span id="L549"><span class="lineNum"> 549</span> : : </span> |
| <span id="L550"><span class="lineNum"> 550</span> :<span class="tlaUNC"> 0 : ecc_pos = with_ecc_pos(ecc_start, pos);</span></span> |
| <span id="L551"><span class="lineNum"> 551</span> :<span class="tlaUNC"> 0 : ecc_align = ecc_buffer_align(ecc_start, ecc_pos);</span></span> |
| <span id="L552"><span class="lineNum"> 552</span> :<span class="tlaUNC"> 0 : ecc_diff = ecc_pos - ecc_align;</span></span> |
| <span id="L553"><span class="lineNum"> 553</span> :<span class="tlaUNC"> 0 : ecc_len = ecc_buffer_size(len + ecc_diff);</span></span> |
| <span id="L554"><span class="lineNum"> 554</span> : : </span> |
| <span id="L555"><span class="lineNum"> 555</span> :<span class="tlaUNC"> 0 : ecc_buf = malloc(ecc_len);</span></span> |
| <span id="L556"><span class="lineNum"> 556</span> :<span class="tlaUNC"> 0 : if (!ecc_buf) {</span></span> |
| <span id="L557"><span class="lineNum"> 557</span> :<span class="tlaUNC"> 0 : errno = ENOMEM;</span></span> |
| <span id="L558"><span class="lineNum"> 558</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L559"><span class="lineNum"> 559</span> : : }</span> |
| <span id="L560"><span class="lineNum"> 560</span> : : </span> |
| <span id="L561"><span class="lineNum"> 561</span> :<span class="tlaUNC"> 0 : if (ecc_diff) {</span></span> |
| <span id="L562"><span class="lineNum"> 562</span> :<span class="tlaUNC"> 0 : rc = blocklevel_read(bl, ecc_align, ecc_buf, ecc_diff);</span></span> |
| <span id="L563"><span class="lineNum"> 563</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L564"><span class="lineNum"> 564</span> :<span class="tlaUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L565"><span class="lineNum"> 565</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L566"><span class="lineNum"> 566</span> :<span class="tlaUNC"> 0 : goto out;</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> |
| <span id="L570"><span class="lineNum"> 570</span> :<span class="tlaUNC"> 0 : rc = memcpy_to_ecc_unaligned(ecc_buf, buf, len, ecc_diff);</span></span> |
| <span id="L571"><span class="lineNum"> 571</span> :<span class="tlaUNC"> 0 : if (rc) {</span></span> |
| <span id="L572"><span class="lineNum"> 572</span> :<span class="tlaUNC"> 0 : free(ecc_buf);</span></span> |
| <span id="L573"><span class="lineNum"> 573</span> :<span class="tlaUNC"> 0 : errno = EBADF;</span></span> |
| <span id="L574"><span class="lineNum"> 574</span> :<span class="tlaUNC"> 0 : return FLASH_ERR_ECC_INVALID;</span></span> |
| <span id="L575"><span class="lineNum"> 575</span> : : }</span> |
| <span id="L576"><span class="lineNum"> 576</span> : : </span> |
| <span id="L577"><span class="lineNum"> 577</span> : : write_buf = ecc_buf;</span> |
| <span id="L578"><span class="lineNum"> 578</span> : : write_len = ecc_len;</span> |
| <span id="L579"><span class="lineNum"> 579</span> : : write_pos = ecc_pos;</span> |
| <span id="L580"><span class="lineNum"> 580</span> : : } else {</span> |
| <span id="L581"><span class="lineNum"> 581</span> : : write_buf = buf;</span> |
| <span id="L582"><span class="lineNum"> 582</span> : : write_len = len;</span> |
| <span id="L583"><span class="lineNum"> 583</span> : : write_pos = pos;</span> |
| <span id="L584"><span class="lineNum"> 584</span> : : }</span> |
| <span id="L585"><span class="lineNum"> 585</span> : : </span> |
| <span id="L586"><span class="lineNum"> 586</span> :<span class="tlaUNC"> 0 : erase_buf = malloc(erase_size);</span></span> |
| <span id="L587"><span class="lineNum"> 587</span> :<span class="tlaUNC"> 0 : if (!erase_buf) {</span></span> |
| <span id="L588"><span class="lineNum"> 588</span> :<span class="tlaUNC"> 0 : errno = ENOMEM;</span></span> |
| <span id="L589"><span class="lineNum"> 589</span> :<span class="tlaUNC"> 0 : rc = FLASH_ERR_MALLOC_FAILED;</span></span> |
| <span id="L590"><span class="lineNum"> 590</span> :<span class="tlaUNC"> 0 : goto out_free;</span></span> |
| <span id="L591"><span class="lineNum"> 591</span> : : }</span> |
| <span id="L592"><span class="lineNum"> 592</span> : : </span> |
| <span id="L593"><span class="lineNum"> 593</span> :<span class="tlaUNC"> 0 : rc = reacquire(bl);</span></span> |
| <span id="L594"><span class="lineNum"> 594</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L595"><span class="lineNum"> 595</span> :<span class="tlaUNC"> 0 : goto out_free;</span></span> |
| <span id="L596"><span class="lineNum"> 596</span> : : </span> |
| <span id="L597"><span class="lineNum"> 597</span> :<span class="tlaUNC"> 0 : while (write_len > 0) {</span></span> |
| <span id="L598"><span class="lineNum"> 598</span> :<span class="tlaUNC"> 0 : uint32_t erase_block = write_pos & ~(erase_size - 1);</span></span> |
| <span id="L599"><span class="lineNum"> 599</span> :<span class="tlaUNC"> 0 : uint32_t block_offset = write_pos & (erase_size - 1);</span></span> |
| <span id="L600"><span class="lineNum"> 600</span> :<span class="tlaUNC"> 0 : uint32_t chunk_size = erase_size > write_len ?</span></span> |
| <span id="L601"><span class="lineNum"> 601</span> :<span class="tlaUNC"> 0 : write_len : erase_size;</span></span> |
| <span id="L602"><span class="lineNum"> 602</span> :<span class="tlaUNC"> 0 : int cmp;</span></span> |
| <span id="L603"><span class="lineNum"> 603</span> : : </span> |
| <span id="L604"><span class="lineNum"> 604</span> : : /* Write crosses an erase boundary, shrink the write to the boundary */</span> |
| <span id="L605"><span class="lineNum"> 605</span> :<span class="tlaUNC"> 0 : if (erase_size < block_offset + chunk_size) {</span></span> |
| <span id="L606"><span class="lineNum"> 606</span> :<span class="tlaUNC"> 0 : chunk_size = erase_size - block_offset;</span></span> |
| <span id="L607"><span class="lineNum"> 607</span> : : }</span> |
| <span id="L608"><span class="lineNum"> 608</span> : : </span> |
| <span id="L609"><span class="lineNum"> 609</span> :<span class="tlaUNC"> 0 : rc = bl->read(bl, erase_block, erase_buf, erase_size);</span></span> |
| <span id="L610"><span class="lineNum"> 610</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L611"><span class="lineNum"> 611</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L612"><span class="lineNum"> 612</span> : : </span> |
| <span id="L613"><span class="lineNum"> 613</span> :<span class="tlaUNC"> 0 : cmp = blocklevel_flashcmp(erase_buf + block_offset, write_buf,</span></span> |
| <span id="L614"><span class="lineNum"> 614</span> : : chunk_size);</span> |
| <span id="L615"><span class="lineNum"> 615</span> :<span class="tlaUNC"> 0 : FL_DBG("%s: region 0x%08x..0x%08x ", __func__,</span></span> |
| <span id="L616"><span class="lineNum"> 616</span> : : erase_block, erase_size);</span> |
| <span id="L617"><span class="lineNum"> 617</span> :<span class="tlaUNC"> 0 : if (cmp != 0) {</span></span> |
| <span id="L618"><span class="lineNum"> 618</span> :<span class="tlaUNC"> 0 : FL_DBG("needs ");</span></span> |
| <span id="L619"><span class="lineNum"> 619</span> :<span class="tlaUNC"> 0 : if (cmp == -1) {</span></span> |
| <span id="L620"><span class="lineNum"> 620</span> :<span class="tlaUNC"> 0 : FL_DBG("erase and ");</span></span> |
| <span id="L621"><span class="lineNum"> 621</span> :<span class="tlaUNC"> 0 : bl->erase(bl, erase_block, erase_size);</span></span> |
| <span id="L622"><span class="lineNum"> 622</span> : : }</span> |
| <span id="L623"><span class="lineNum"> 623</span> :<span class="tlaUNC"> 0 : FL_DBG("write\n");</span></span> |
| <span id="L624"><span class="lineNum"> 624</span> :<span class="tlaUNC"> 0 : memcpy(erase_buf + block_offset, write_buf, chunk_size);</span></span> |
| <span id="L625"><span class="lineNum"> 625</span> :<span class="tlaUNC"> 0 : rc = bl->write(bl, erase_block, erase_buf, erase_size);</span></span> |
| <span id="L626"><span class="lineNum"> 626</span> :<span class="tlaUNC"> 0 : if (rc)</span></span> |
| <span id="L627"><span class="lineNum"> 627</span> :<span class="tlaUNC"> 0 : goto out;</span></span> |
| <span id="L628"><span class="lineNum"> 628</span> : : } else {</span> |
| <span id="L629"><span class="lineNum"> 629</span> :<span class="tlaUNC"> 0 : FL_DBG("clean\n");</span></span> |
| <span id="L630"><span class="lineNum"> 630</span> : : }</span> |
| <span id="L631"><span class="lineNum"> 631</span> : : </span> |
| <span id="L632"><span class="lineNum"> 632</span> :<span class="tlaUNC"> 0 : write_len -= chunk_size;</span></span> |
| <span id="L633"><span class="lineNum"> 633</span> :<span class="tlaUNC"> 0 : write_pos += chunk_size;</span></span> |
| <span id="L634"><span class="lineNum"> 634</span> :<span class="tlaUNC"> 0 : write_buf += chunk_size;</span></span> |
| <span id="L635"><span class="lineNum"> 635</span> : : }</span> |
| <span id="L636"><span class="lineNum"> 636</span> : : </span> |
| <span id="L637"><span class="lineNum"> 637</span> :<span class="tlaUNC"> 0 : out:</span></span> |
| <span id="L638"><span class="lineNum"> 638</span> :<span class="tlaUNC"> 0 : release(bl);</span></span> |
| <span id="L639"><span class="lineNum"> 639</span> :<span class="tlaUNC"> 0 : out_free:</span></span> |
| <span id="L640"><span class="lineNum"> 640</span> :<span class="tlaUNC"> 0 : free(ecc_buf);</span></span> |
| <span id="L641"><span class="lineNum"> 641</span> :<span class="tlaUNC"> 0 : free(erase_buf);</span></span> |
| <span id="L642"><span class="lineNum"> 642</span> :<span class="tlaUNC"> 0 : return rc;</span></span> |
| <span id="L643"><span class="lineNum"> 643</span> : : }</span> |
| <span id="L644"><span class="lineNum"> 644</span> : : </span> |
| <span id="L645"><span class="lineNum"> 645</span> :<span class="tlaGNC tlaBgGNC"> 20 : static bool insert_bl_prot_range(struct blocklevel_range *ranges, struct bl_prot_range range)</span></span> |
| <span id="L646"><span class="lineNum"> 646</span> : : {</span> |
| <span id="L647"><span class="lineNum"> 647</span> :<span class="tlaGNC"> 20 : int i;</span></span> |
| <span id="L648"><span class="lineNum"> 648</span> :<span class="tlaGNC"> 20 : uint32_t pos, len;</span></span> |
| <span id="L649"><span class="lineNum"> 649</span> :<span class="tlaGNC"> 20 : struct bl_prot_range *prot = ranges->prot;</span></span> |
| <span id="L650"><span class="lineNum"> 650</span> : : </span> |
| <span id="L651"><span class="lineNum"> 651</span> :<span class="tlaGNC"> 20 : pos = range.start;</span></span> |
| <span id="L652"><span class="lineNum"> 652</span> :<span class="tlaGNC"> 20 : len = range.len;</span></span> |
| <span id="L653"><span class="lineNum"> 653</span> : : </span> |
| <span id="L654"><span class="lineNum"> 654</span> :<span class="tlaGNC"> 20 : if (len == 0)</span></span> |
| <span id="L655"><span class="lineNum"> 655</span> : : return true;</span> |
| <span id="L656"><span class="lineNum"> 656</span> : : </span> |
| <span id="L657"><span class="lineNum"> 657</span> : : /* Check for overflow */</span> |
| <span id="L658"><span class="lineNum"> 658</span> :<span class="tlaGNC"> 20 : if (pos + len < len)</span></span> |
| <span id="L659"><span class="lineNum"> 659</span> : : return false;</span> |
| <span id="L660"><span class="lineNum"> 660</span> : : </span> |
| <span id="L661"><span class="lineNum"> 661</span> :<span class="tlaGNC"> 50 : for (i = 0; i < ranges->n_prot && len > 0; i++) {</span></span> |
| <span id="L662"><span class="lineNum"> 662</span> :<span class="tlaGNC"> 30 : if (prot[i].start <= pos && prot[i].start + prot[i].len >= pos + len) {</span></span> |
| <span id="L663"><span class="lineNum"> 663</span> : : len = 0;</span> |
| <span id="L664"><span class="lineNum"> 664</span> : : break; /* Might as well, the next two conditions can't be true */</span> |
| <span id="L665"><span class="lineNum"> 665</span> : : }</span> |
| <span id="L666"><span class="lineNum"> 666</span> : : </span> |
| <span id="L667"><span class="lineNum"> 667</span> : : /* Can easily extend this down just by adjusting start */</span> |
| <span id="L668"><span class="lineNum"> 668</span> :<span class="tlaGNC"> 30 : if (pos <= prot[i].start && pos + len >= prot[i].start) {</span></span> |
| <span id="L669"><span class="lineNum"> 669</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("%s: extending start down\n", __func__);</span></span> |
| <span id="L670"><span class="lineNum"> 670</span> :<span class="tlaUNC"> 0 : prot[i].len += prot[i].start - pos;</span></span> |
| <span id="L671"><span class="lineNum"> 671</span> :<span class="tlaUNC"> 0 : prot[i].start = pos;</span></span> |
| <span id="L672"><span class="lineNum"> 672</span> :<span class="tlaUNC"> 0 : pos += prot[i].len;</span></span> |
| <span id="L673"><span class="lineNum"> 673</span> :<span class="tlaUNC"> 0 : if (prot[i].len >= len)</span></span> |
| <span id="L674"><span class="lineNum"> 674</span> : : len = 0;</span> |
| <span id="L675"><span class="lineNum"> 675</span> : : else</span> |
| <span id="L676"><span class="lineNum"> 676</span> :<span class="tlaUNC"> 0 : len -= prot[i].len;</span></span> |
| <span id="L677"><span class="lineNum"> 677</span> : : }</span> |
| <span id="L678"><span class="lineNum"> 678</span> : : </span> |
| <span id="L679"><span class="lineNum"> 679</span> : : /*</span> |
| <span id="L680"><span class="lineNum"> 680</span> : : * Jump over this range but the new range might be so big that</span> |
| <span id="L681"><span class="lineNum"> 681</span> : : * theres a chunk after</span> |
| <span id="L682"><span class="lineNum"> 682</span> : : */</span> |
| <span id="L683"><span class="lineNum"> 683</span> :<span class="tlaGNC tlaBgGNC"> 30 : if (pos >= prot[i].start && pos < prot[i].start + prot[i].len) {</span></span> |
| <span id="L684"><span class="lineNum"> 684</span> :<span class="tlaUNC tlaBgUNC"> 0 : FL_DBG("%s: fits within current range ", __func__);</span></span> |
| <span id="L685"><span class="lineNum"> 685</span> :<span class="tlaUNC"> 0 : if (prot[i].start + prot[i].len - pos > len) {</span></span> |
| <span id="L686"><span class="lineNum"> 686</span> :<span class="tlaUNC"> 0 : FL_DBG("but there is some extra at the end\n");</span></span> |
| <span id="L687"><span class="lineNum"> 687</span> :<span class="tlaUNC"> 0 : len -= prot[i].start + prot[i].len - pos;</span></span> |
| <span id="L688"><span class="lineNum"> 688</span> :<span class="tlaUNC"> 0 : pos = prot[i].start + prot[i].len;</span></span> |
| <span id="L689"><span class="lineNum"> 689</span> : : } else {</span> |
| <span id="L690"><span class="lineNum"> 690</span> :<span class="tlaUNC"> 0 : FL_DBG("\n");</span></span> |
| <span id="L691"><span class="lineNum"> 691</span> : : len = 0;</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> : : /*</span> |
| <span id="L695"><span class="lineNum"> 695</span> : : * This condition will be true if the range is smaller than</span> |
| <span id="L696"><span class="lineNum"> 696</span> : : * the current range, therefore it should go here!</span> |
| <span id="L697"><span class="lineNum"> 697</span> : : */</span> |
| <span id="L698"><span class="lineNum"> 698</span> :<span class="tlaGNC tlaBgGNC"> 30 : if (pos < prot[i].start && pos + len <= prot[i].start)</span></span> |
| <span id="L699"><span class="lineNum"> 699</span> : : break;</span> |
| <span id="L700"><span class="lineNum"> 700</span> : : }</span> |
| <span id="L701"><span class="lineNum"> 701</span> : : </span> |
| <span id="L702"><span class="lineNum"> 702</span> :<span class="tlaGNC"> 20 : if (len) {</span></span> |
| <span id="L703"><span class="lineNum"> 703</span> :<span class="tlaGNC"> 20 : int insert_pos = i;</span></span> |
| <span id="L704"><span class="lineNum"> 704</span> :<span class="tlaGNC"> 20 : struct bl_prot_range *new_ranges = ranges->prot;</span></span> |
| <span id="L705"><span class="lineNum"> 705</span> : : </span> |
| <span id="L706"><span class="lineNum"> 706</span> :<span class="tlaGNC"> 20 : FL_DBG("%s: adding 0x%08x..0x%08x\n", __func__, pos, pos + len);</span></span> |
| <span id="L707"><span class="lineNum"> 707</span> : : </span> |
| <span id="L708"><span class="lineNum"> 708</span> :<span class="tlaGNC"> 20 : if (ranges->n_prot == ranges->total_prot) {</span></span> |
| <span id="L709"><span class="lineNum"> 709</span> :<span class="tlaGNC"> 5 : new_ranges = realloc(ranges->prot,</span></span> |
| <span id="L710"><span class="lineNum"> 710</span> :<span class="tlaGNC"> 5 : sizeof(range) * ((ranges->n_prot) + PROT_REALLOC_NUM));</span></span> |
| <span id="L711"><span class="lineNum"> 711</span> :<span class="tlaGNC"> 5 : if (!new_ranges)</span></span> |
| <span id="L712"><span class="lineNum"> 712</span> : : return false;</span> |
| <span id="L713"><span class="lineNum"> 713</span> :<span class="tlaGNC"> 5 : ranges->total_prot += PROT_REALLOC_NUM;</span></span> |
| <span id="L714"><span class="lineNum"> 714</span> : : }</span> |
| <span id="L715"><span class="lineNum"> 715</span> :<span class="tlaGNC"> 20 : if (insert_pos != ranges->n_prot)</span></span> |
| <span id="L716"><span class="lineNum"> 716</span> :<span class="tlaUNC tlaBgUNC"> 0 : for (i = ranges->n_prot; i > insert_pos; i--)</span></span> |
| <span id="L717"><span class="lineNum"> 717</span> :<span class="tlaUNC"> 0 : memcpy(&new_ranges[i], &new_ranges[i - 1], sizeof(range));</span></span> |
| <span id="L718"><span class="lineNum"> 718</span> :<span class="tlaGNC tlaBgGNC"> 20 : range.start = pos;</span></span> |
| <span id="L719"><span class="lineNum"> 719</span> :<span class="tlaGNC"> 20 : range.len = len;</span></span> |
| <span id="L720"><span class="lineNum"> 720</span> :<span class="tlaGNC"> 20 : memcpy(&new_ranges[insert_pos], &range, sizeof(range));</span></span> |
| <span id="L721"><span class="lineNum"> 721</span> :<span class="tlaGNC"> 20 : ranges->prot = new_ranges;</span></span> |
| <span id="L722"><span class="lineNum"> 722</span> :<span class="tlaGNC"> 20 : ranges->n_prot++;</span></span> |
| <span id="L723"><span class="lineNum"> 723</span> :<span class="tlaGNC"> 20 : prot = new_ranges;</span></span> |
| <span id="L724"><span class="lineNum"> 724</span> : : }</span> |
| <span id="L725"><span class="lineNum"> 725</span> : : </span> |
| <span id="L726"><span class="lineNum"> 726</span> : : return true;</span> |
| <span id="L727"><span class="lineNum"> 727</span> : : }</span> |
| <span id="L728"><span class="lineNum"> 728</span> : : </span> |
| <span id="L729"><span class="lineNum"> 729</span> :<span class="tlaGNC"> 20 : int blocklevel_ecc_protect(struct blocklevel_device *bl, uint32_t start, uint32_t len)</span></span> |
| <span id="L730"><span class="lineNum"> 730</span> : : {</span> |
| <span id="L731"><span class="lineNum"> 731</span> : : /*</span> |
| <span id="L732"><span class="lineNum"> 732</span> : : * Could implement this at hardware level by having an accessor to the</span> |
| <span id="L733"><span class="lineNum"> 733</span> : : * backend in struct blocklevel_device and as a result do nothing at</span> |
| <span id="L734"><span class="lineNum"> 734</span> : : * this level (although probably not for ecc!)</span> |
| <span id="L735"><span class="lineNum"> 735</span> : : */</span> |
| <span id="L736"><span class="lineNum"> 736</span> :<span class="tlaGNC"> 20 : struct bl_prot_range range = { .start = start, .len = len };</span></span> |
| <span id="L737"><span class="lineNum"> 737</span> : : </span> |
| <span id="L738"><span class="lineNum"> 738</span> :<span class="tlaGNC"> 20 : if (len < BYTES_PER_ECC)</span></span> |
| <span id="L739"><span class="lineNum"> 739</span> : : return -1;</span> |
| <span id="L740"><span class="lineNum"> 740</span> :<span class="tlaGNC"> 20 : return !insert_bl_prot_range(&bl->ecc_prot, range);</span></span> |
| <span id="L741"><span class="lineNum"> 741</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> |
