WriteExecuteFirmware1.c.html 7.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213
  1. <?xml version='1.0' encoding='iso-8859-1'?>
  2. <!doctype html public '-//W3C//DTD XHTML 1.0 Strict//EN' 'http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd'>
  3. <html xmlns='http://www.w3c.org/1999/xhtml' lang='en-us'>
  4. <head>
  5. <title>
  6. WriteExecuteFirmware1.c
  7. </title>
  8. <meta http-equiv='content-type' content='text/html;iso-8859-1'/>
  9. <meta name='generator' content='motley-tools 1.9.4 13:40:33 Feb 18 2015'/>
  10. <meta name='author' content='cmaier@cmassoc.net'/>
  11. <meta name='robots' content='noindex,nofollow'/>
  12. <link href='toolkit.css' rel='stylesheet' type='text/css'/>
  13. </head>
  14. <body>
  15. <div class='headerlink'>
  16. [<a href='WriteExecuteApplet2.c.html' title=' WriteExecuteApplet2.c '>PREV</a>]
  17. [<a href='toolkit.html' title=' Index '>HOME</a>]
  18. [<a href='WriteExecuteFirmware2.c.html' title=' WriteExecuteFirmware2.c '>NEXT</a>]
  19. </div>
  20. <pre>
  21. /*====================================================================*
  22. *
  23. * Copyright (c) 2013 Qualcomm Atheros, Inc.
  24. *
  25. * All rights reserved.
  26. *
  27. * Redistribution and use in source and binary forms, with or
  28. * without modification, are permitted (subject to the limitations
  29. * in the disclaimer below) provided that the following conditions
  30. * are met:
  31. *
  32. * * Redistributions of source code must retain the above copyright
  33. * notice, this list of conditions and the following disclaimer.
  34. *
  35. * * Redistributions in binary form must reproduce the above
  36. * copyright notice, this list of conditions and the following
  37. * disclaimer in the documentation and/or other materials
  38. * provided with the distribution.
  39. *
  40. * * Neither the name of Qualcomm Atheros nor the names of
  41. * its contributors may be used to endorse or promote products
  42. * derived from this software without specific prior written
  43. * permission.
  44. *
  45. * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
  46. * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE
  47. * COPYRIGHT HOLDERS AND CONTRIBUTORS &quot;AS IS&quot; AND ANY EXPRESS OR
  48. * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  49. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  50. * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
  51. * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  52. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  53. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  54. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  55. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  56. * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  57. * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  58. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  59. *
  60. *--------------------------------------------------------------------*/
  61. /*====================================================================*
  62. *
  63. * signed WriteExecuteFirmware1 (struct plc * plc, unsigned module, const struct nvm_header1 * nvm_header);
  64. *
  65. * plc.h
  66. *
  67. * write firmware image into SDRAM and start execution using the
  68. * VS_WRITE_AND_EXECUTE_APPLET message when the image is in legacy
  69. * file format;
  70. *
  71. * the boot loader must be running for this to work since runtime
  72. * firmware ignores VS_WRITE_AND_EXECUTE_APPLET messages;
  73. *
  74. *
  75. * Contributor(s):
  76. * Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
  77. *
  78. *--------------------------------------------------------------------*/
  79. #ifndef WRITEEXECUTEFIRMWARE1_SOURCE
  80. #define WRITEEXECUTEFIRMWARE1_SOURCE
  81. #include &quot;../tools/files.h&quot;
  82. #include &quot;../tools/error.h&quot;
  83. #include &quot;../plc/plc.h&quot;
  84. signed WriteExecuteFirmware1 (struct plc * plc, unsigned module, const struct nvm_header1 * nvm_header)
  85. {
  86. struct channel * channel = (struct channel *)(plc-&gt;channel);
  87. struct message * message = (struct message *)(plc-&gt;message);
  88. #ifndef __GNUC__
  89. #pragma pack (push,1)
  90. #endif
  91. struct __packed vs_write_execute_request
  92. {
  93. struct ethernet_hdr ethernet;
  94. struct qualcomm_hdr qualcomm;
  95. uint32_t CLIENT_SESSION_ID;
  96. uint32_t SERVER_SESSION_ID;
  97. uint32_t FLAGS;
  98. uint8_t ALLOWED_MEM_TYPES [8];
  99. uint32_t TOTAL_LENGTH;
  100. uint32_t CURR_PART_LENGTH;
  101. uint32_t CURR_PART_OFFSET;
  102. uint32_t START_ADDR;
  103. uint32_t CHECKSUM;
  104. uint8_t RESERVED2 [8];
  105. uint8_t IMAGE [PLC_MODULE_SIZE];
  106. }
  107. * request = (struct vs_write_execute_request *) (message);
  108. struct __packed vs_write_execute_confirm
  109. {
  110. struct ethernet_hdr ethernet;
  111. struct qualcomm_hdr qualcomm;
  112. uint32_t MSTATUS;
  113. uint32_t CLIENT_SESSION_ID;
  114. uint32_t SERVER_SESSION_ID;
  115. uint32_t FLAGS;
  116. uint8_t ALLOWED_MEM_TYPES [8];
  117. uint32_t TOTAL_LENGTH;
  118. uint32_t CURR_PART_LENGTH;
  119. uint32_t CURR_PART_OFFSET;
  120. uint32_t START_ADDR;
  121. uint32_t CHECKSUM;
  122. uint8_t RESERVED2 [8];
  123. uint32_t CURR_PART_ABSOLUTE_ADDR;
  124. uint32_t ABSOLUTE_START_ADDR;
  125. }
  126. * confirm = (struct vs_write_execute_confirm *) (message);
  127. #ifndef __GNUC__
  128. #pragma pack (pop)
  129. #endif
  130. unsigned action = PLC_MODULE_ABSOLUTE;
  131. uint32_t length = PLC_MODULE_SIZE;
  132. uint32_t offset = LE32TOH (nvm_header-&gt;IMAGEADDRESS);
  133. uint32_t extent = LE32TOH (nvm_header-&gt;IMAGELENGTH);
  134. Request (plc, &quot;Write %s (%d) (%08X:%d)&quot;, plc-&gt;NVM.name, module, offset, extent);
  135. while (extent)
  136. {
  137. memset (message, 0, sizeof (* message));
  138. EthernetHeader (&amp;request-&gt;ethernet, channel-&gt;peer, channel-&gt;host, channel-&gt;type);
  139. QualcommHeader (&amp;request-&gt;qualcomm, 0, (VS_WRITE_AND_EXECUTE_APPLET | MMTYPE_REQ));
  140. if (length &gt; extent)
  141. {
  142. if (!(LE32TOH(nvm_header-&gt;ENTRYPOINT) % sizeof(nvm_header-&gt;ENTRYPOINT)))
  143. {
  144. Request (plc, &quot;Start %s (%d) (%08X)&quot;, plc-&gt;NVM.name, module, LE32TOH (nvm_header-&gt;ENTRYPOINT));
  145. action |= PLC_MODULE_EXECUTE;
  146. }
  147. length = extent;
  148. }
  149. if (read (plc-&gt;NVM.file, request-&gt;IMAGE, length) != (signed)(length))
  150. {
  151. error (1, errno, FILE_CANTREAD, plc-&gt;NVM.name);
  152. }
  153. request-&gt;CLIENT_SESSION_ID = HTOLE32 (plc-&gt;cookie);
  154. request-&gt;SERVER_SESSION_ID = HTOLE32 (0);
  155. request-&gt;FLAGS = HTOLE32 (action);
  156. request-&gt;ALLOWED_MEM_TYPES [0] = 1;
  157. request-&gt;TOTAL_LENGTH = nvm_header-&gt;IMAGELENGTH;
  158. request-&gt;CURR_PART_LENGTH = HTOLE32 (length);
  159. request-&gt;CURR_PART_OFFSET = HTOLE32 (offset);
  160. request-&gt;START_ADDR = nvm_header-&gt;ENTRYPOINT;
  161. request-&gt;CHECKSUM = nvm_header-&gt;IMAGECHECKSUM;
  162. plc-&gt;packetsize = sizeof (* request);
  163. if (SendMME (plc) &lt;= 0)
  164. {
  165. error (PLC_EXIT (plc), errno, CHANNEL_CANTSEND);
  166. return (-1);
  167. }
  168. if (ReadMME (plc, 0, (VS_WRITE_AND_EXECUTE_APPLET | MMTYPE_CNF)) &lt;= 0)
  169. {
  170. error (PLC_EXIT (plc), errno, CHANNEL_CANTREAD);
  171. return (-1);
  172. }
  173. if (confirm-&gt;MSTATUS)
  174. {
  175. Failure (plc, PLC_WONTDOIT);
  176. return (-1);
  177. }
  178. if (LE32TOH (confirm-&gt;CURR_PART_LENGTH) != length)
  179. {
  180. error (PLC_EXIT (plc), 0, PLC_ERR_LENGTH);
  181. return (-1);
  182. }
  183. if (LE32TOH (confirm-&gt;CURR_PART_OFFSET) != offset)
  184. {
  185. error (PLC_EXIT (plc), 0, PLC_ERR_OFFSET);
  186. return (-1);
  187. }
  188. offset += length;
  189. extent -= length;
  190. }
  191. return (0);
  192. }
  193. #endif
  194. </pre>
  195. <div class='footerlink'>
  196. [<a href='WriteExecuteApplet2.c.html' title=' WriteExecuteApplet2.c '>PREV</a>]
  197. [<a href='toolkit.html' title=' Index '>HOME</a>]
  198. [<a href='WriteExecuteFirmware2.c.html' title=' WriteExecuteFirmware2.c '>NEXT</a>]
  199. </div>
  200. </body>
  201. </html>