Inicio Explorar Axuda
Rexistro Iniciar sesión
abhinav
/
remote-camera-shutter
1
0
Fork 0
Ficheiros Incidencias 0 Pull Requests 0 Wiki
Rama: master
Ramas Etiquetas
remote-camer...
/
NRF24_for_attiny
/
doc
/
crazyflie_8ino-example.html

crazyflie_8ino-example.html 21 KB
Permalink Histórico Raw

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273 
  1. <!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
    2. 

  2. <html xmlns="http://www.w3.org/1999/xhtml">
    3. 

  3. <head>
    4. 

  4. <meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
    5. 

  5. <meta http-equiv="X-UA-Compatible" content="IE=9"/>
    6. 

  6. <meta name="generator" content="Doxygen 1.8.5"/>
    7. 

  7. <title>NRF24: crazyflie.ino</title>
    8. 

  8. <link href="tabs.css" rel="stylesheet" type="text/css"/>
    9. 

  9. <script type="text/javascript" src="jquery.js"></script>
    10. 

  10. <script type="text/javascript" src="dynsections.js"></script>
    11. 

  11. <link href="doxygen.css" rel="stylesheet" type="text/css" />
    12. 

  12. </head>
    13. 

  13. <body>
    14. 

  14. <div id="top"><!-- do not remove this div, it is closed by doxygen! -->
    15. 

  15. <div id="titlearea">
    16. 

  16. <table cellspacing="0" cellpadding="0">
    17. 

  17.  <tbody>
    18. 

  18.  <tr style="height: 56px;">
    19. 

  19.   <td style="padding-left: 0.5em;">
    20. 

  20.    <div id="projectname">NRF24
    21. 

  21.    </div>
    22. 

  22.   </td>
    23. 

  23.  </tr>
    24. 

  24.  </tbody>
    25. 

  25. </table>
    26. 

  26. </div>
    27. 

  27. <!-- end header part -->
    28. 

  28. <!-- Generated by Doxygen 1.8.5 -->
    29. 

  29.   <div id="navrow1" class="tabs">
    30. 

  30.     <ul class="tablist">
    31. 

  31.       <li><a href="index.html"><span>Main&#160;Page</span></a></li>
    32. 

  32.       <li><a href="annotated.html"><span>Classes</span></a></li>
    33. 

  33.       <li><a href="files.html"><span>Files</span></a></li>
    34. 

  34.       <li><a href="examples.html"><span>Examples</span></a></li>
    35. 

  35.     </ul>
    36. 

  36.   </div>
    37. 

  37. </div><!-- top -->
    38. 

  38. <div class="header">
    39. 

  39.   <div class="headertitle">
    40. 

  40. <div class="title">crazyflie.ino</div>  </div>
    41. 

  41. </div><!--header-->
    42. 

  42. <div class="contents">
    43. 

  43. <p>This sketch act like a Crazyflie quadcopter <a href="http://www.bitcraze.se/">http://www.bitcraze.se/</a> using the CRTP radiolink protocol: <a href="http://wiki.bitcraze.se/projects:crazyflie:firmware:comm_protocol">http://wiki.bitcraze.se/projects:crazyflie:firmware:comm_protocol</a></p>
    44. 

  44. <div class="fragment"><div class="line"><span class="comment">// crazyflie.pde</span></div>
    45. 

  45. <div class="line"><span class="comment">// -*- mode: C++ -*-</span></div>
    46. 

  46. <div class="line"><span class="comment">//</span></div>
    47. 

  47. <div class="line"><span class="comment">// This sketch act like a Crazyflie quadcopter http://www.bitcraze.se/</span></div>
    48. 

  48. <div class="line"><span class="comment">// using the CRTP radiolink protocol:</span></div>
    49. 

  49. <div class="line"><span class="comment">// http://wiki.bitcraze.se/projects:crazyflie:firmware:comm_protocol</span></div>
    50. 

  50. <div class="line"><span class="comment">//</span></div>
    51. 

  51. <div class="line"><span class="comment">// Requires </span></div>
    52. 

  52. <div class="line"><span class="comment">// - NRF24 radio module such as the sparkfun WRL-00691 http://www.sparkfun.com/products/691</span></div>
    53. 

  53. <div class="line"><span class="comment">// - Arduino such as Uno</span></div>
    54. 

  54. <div class="line"><span class="comment">// - A Crazyflie transmitter, such as the Carzyflie PC client+CrazyRadio module</span></div>
    55. 

  55. <div class="line"><span class="comment">// or</span></div>
    56. 

  56. <div class="line"><span class="comment">// the NRF24 crazyflie client part of the NRF24 library</span></div>
    57. 

  57. <div class="line"><span class="comment">//</span></div>
    58. 

  58. <div class="line"><span class="comment">// Uses NRF24 library to comunicate with the Crazyflie, </span></div>
    59. 

  59. <div class="line"><span class="comment">// http://www.airspayce.com/mikem/arduino/NRF24</span></div>
    60. 

  60. <div class="line"><span class="comment">//</span></div>
    61. 

  61. <div class="line"><span class="comment">// Receives and decodes varion message types from teh Crazyflie transmitter, although</span></div>
    62. 

  62. <div class="line"><span class="comment">// only the link echo and commander messages are fully implemented</span></div>
    63. 

  63. <div class="line"><span class="comment">//</span></div>
    64. 

  64. <div class="line"><span class="comment">// Author: Mike McCauley</span></div>
    65. 

  65. <div class="line"><span class="comment">// Copyright (C) 2012 Mike McCauley</span></div>
    66. 

  66. <div class="line"></div>
    67. 

  67. <div class="line"><span class="preprocessor">#include &lt;NRF24.h&gt;</span></div>
    68. 

  68. <div class="line"><span class="preprocessor">#include &lt;SPI.h&gt;</span></div>
    69. 

  69. <div class="line"></div>
    70. 

  70. <div class="line"><span class="comment">// Structure of Crazyflie commander messages</span></div>
    71. 

  71. <div class="line"><span class="preprocessor">#pragma pack(1);</span></div>
    72. 

  72. <div class="line"><span class="preprocessor"></span><span class="keyword">typedef</span> <span class="keyword">struct </span></div>
    73. 

  73. <div class="line">{</div>
    74. 

  74. <div class="line">  <span class="keywordtype">float</span> roll;</div>
    75. 

  75. <div class="line">  <span class="keywordtype">float</span> pitch;</div>
    76. 

  76. <div class="line">  <span class="keywordtype">float</span> yaw;</div>
    77. 

  77. <div class="line">  uint16_t thrust;</div>
    78. 

  78. <div class="line">} CommanderCrtpValues;</div>
    79. 

  79. <div class="line"><span class="preprocessor">#pragma pack()</span></div>
    80. 

  80. <div class="line"><span class="preprocessor"></span></div>
    81. 

  81. <div class="line"><span class="comment">// Useful macros for CRTP message contents and formatting</span></div>
    82. 

  82. <div class="line"><span class="preprocessor">#define CRTP_HEADER(port, channel) (((port &amp; 0x0F) &lt;&lt; 4) | (channel &amp; 0x0F))</span></div>
    83. 

  83. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define CRTP_HEADER_PORT(h) ((h &gt;&gt; 4) &amp; 0xf)</span></div>
    84. 

  84. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define CRTP_HEADER_CHANNEL(h) (h &amp; 0x3)</span></div>
    85. 

  85. <div class="line"><span class="preprocessor"></span></div>
    86. 

  86. <div class="line"><span class="comment">// Param channels</span></div>
    87. 

  87. <div class="line"><span class="preprocessor">#define PARAM_TOC_CH 0</span></div>
    88. 

  88. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define PARAM_READ_CH 1</span></div>
    89. 

  89. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define PARAM_WRITE_CH 2</span></div>
    90. 

  90. <div class="line"><span class="preprocessor"></span></div>
    91. 

  91. <div class="line"><span class="comment">// Log channels</span></div>
    92. 

  92. <div class="line"><span class="preprocessor">#define LOG_TOC_CH 0</span></div>
    93. 

  93. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define LOG_CONTROL_CH 1</span></div>
    94. 

  94. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define LOG_LOG_CH 2</span></div>
    95. 

  95. <div class="line"><span class="preprocessor"></span><span class="comment">// Log packet parameters storage</span></div>
    96. 

  96. <div class="line"><span class="preprocessor">#define LOG_MAX_OPS 64</span></div>
    97. 

  97. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define LOG_MAX_BLOCKS 8</span></div>
    98. 

  98. <div class="line"><span class="preprocessor"></span></div>
    99. 

  99. <div class="line"><span class="comment">// Port definitions</span></div>
    100. 

  100. <div class="line"><span class="keyword">typedef</span> <span class="keyword">enum</span> {</div>
    101. 

  101. <div class="line">  CRTP_PORT_CONSOLE     = 0x00,</div>
    102. 

  102. <div class="line">  CRTP_PORT_PARAM       = 0x02,</div>
    103. 

  103. <div class="line">  CRTP_PORT_COMMANDER   = 0x03,</div>
    104. 

  104. <div class="line">  CRTP_PORT_LOG         = 0x05,</div>
    105. 

  105. <div class="line">  CRTP_PORT_LINK        = 0x0F,</div>
    106. 

  106. <div class="line">} CRTPPort;</div>
    107. 

  107. <div class="line"></div>
    108. 

  108. <div class="line"><span class="comment">// Common command numbers</span></div>
    109. 

  109. <div class="line"><span class="preprocessor">#define CMD_GET_ITEM 0</span></div>
    110. 

  110. <div class="line"><span class="preprocessor"></span><span class="preprocessor">#define CMD_GET_INFO 1</span></div>
    111. 

  111. <div class="line"><span class="preprocessor"></span></div>
    112. 

  112. <div class="line"><span class="comment">// Singleton instance of the radio</span></div>
    113. 

  113. <div class="line"><a name="_a0"></a><a class="code" href="classNRF24.html">NRF24</a> nrf24;</div>
    114. 

  114. <div class="line"><span class="comment">// NRF24 nrf24(8, 7); // use this to be electrically compatible with Mirf</span></div>
    115. 

  115. <div class="line"><span class="comment">// NRF24 nrf24(8, 10);// For Leonardo, need explicit SS pin</span></div>
    116. 

  116. <div class="line"></div>
    117. 

  117. <div class="line"><span class="comment">// The address to use for this Crazyflie</span></div>
    118. 

  118. <div class="line">uint8_t address[] = { 0xe7, 0xe7, 0xe7, 0xe7, 0xe7 };</div>
    119. 

  119. <div class="line"></div>
    120. 

  120. <div class="line"><span class="keywordtype">void</span> setup() </div>
    121. 

  121. <div class="line">{</div>
    122. 

  122. <div class="line">  Serial.begin(115200);</div>
    123. 

  123. <div class="line">  <span class="keywordflow">while</span> (!Serial)</div>
    124. 

  124. <div class="line">    ; <span class="comment">// Wait for serial port, only required for Leonardo</span></div>
    125. 

  125. <div class="line"></div>
    126. 

  126. <div class="line">  <span class="keywordflow">if</span> (!nrf24.<a name="a1"></a><a class="code" href="classNRF24.html#a6e98cf508939240c1805245170a995f6">init</a>())</div>
    127. 

  127. <div class="line">    Serial.println(<span class="stringliteral">&quot;NRF24 init failed&quot;</span>);</div>
    128. 

  128. <div class="line"></div>
    129. 

  129. <div class="line">  <span class="comment">// Be Crazyflie radiolink compatible</span></div>
    130. 

  130. <div class="line">  <span class="comment">// We use the NRF24 library for convenience, but</span></div>
    131. 

  131. <div class="line">  <span class="comment">// we use a different configuration to the default NRF24</span></div>
    132. 

  132. <div class="line">  <span class="keywordflow">if</span> (!nrf24.<a name="a2"></a><a class="code" href="classNRF24.html#a3fa90005f98eb2744a533899f9b7e023">setChannel</a>(13))</div>
    133. 

  133. <div class="line">     Serial.println(<span class="stringliteral">&quot;setChannel failed&quot;</span>);</div>
    134. 

  134. <div class="line">  <span class="comment">// Set data rate to 250k and low power</span></div>
    135. 

  135. <div class="line">  <span class="keywordflow">if</span> (!nrf24.<a name="a3"></a><a class="code" href="classNRF24.html#a3453db8390d5be4aa99d8c7fde3062a4">setRF</a>(<a name="a4"></a><a class="code" href="classNRF24.html#a52d7af9188397d4a6f5dab55d4f04742ae4523002495ee537f2731b61a220e3af">NRF24::NRF24DataRate250kbps</a>, <a name="a5"></a><a class="code" href="classNRF24.html#a8386e81a9a4b824ab26e785879684c7eacef1d6c037e276e6dadaff2b6056ec0c">NRF24::NRF24TransmitPower0dBm</a>))</div>
    136. 

  136. <div class="line">     Serial.println(<span class="stringliteral">&quot;setRF failed&quot;</span>);  </div>
    137. 

  137. <div class="line">  <span class="keywordflow">if</span> (!nrf24.<a name="a6"></a><a class="code" href="classNRF24.html#a28b29969592f9f59c267ae7ffa020b2b">setPipeAddress</a>(0, address, <span class="keyword">sizeof</span>(address)))</div>
    138. 

  138. <div class="line">     Serial.println(<span class="stringliteral">&quot;setPipeAddress failed&quot;</span>);  </div>
    139. 

  139. <div class="line">  <span class="comment">// Be compatible with Crazyflie: No interrupts, 2 bytes CRC</span></div>
    140. 

  140. <div class="line">  nrf24.<a name="a7"></a><a class="code" href="classNRF24.html#a790d69e5cb1039fb2924f9405e30e250">setConfiguration</a>(NRF24_MASK_RX_DR | NRF24_MASK_TX_DS | NRF24_MASK_MAX_RT | NRF24_EN_CRC | NRF24_CRCO);</div>
    141. 

  141. <div class="line">  nrf24.<a name="a8"></a><a class="code" href="classNRF24.html#a81931bc1679b213b1cb1ae65b8357985">spiWriteRegister</a>(NRF24_REG_1D_FEATURE, NRF24_EN_DPL | NRF24_EN_ACK_PAY);   <span class="comment">// Dynamic size payload + ack</span></div>
    142. 

  142. <div class="line">  nrf24.<a class="code" href="classNRF24.html#a81931bc1679b213b1cb1ae65b8357985">spiWriteRegister</a>(NRF24_REG_1C_DYNPD, NRF24_DPL_P0);     <span class="comment">// Dynamic payload on pipe 0</span></div>
    143. 

  143. <div class="line">  <span class="keywordflow">if</span> (!nrf24.<a name="a9"></a><a class="code" href="classNRF24.html#a1ac9bfce3833725b8b66d9875a8bc00e">setRetry</a>(6, 3)) <span class="comment">// 1500us and 3 retries</span></div>
    144. 

  144. <div class="line">     Serial.println(<span class="stringliteral">&quot;setRetry failed&quot;</span>);  </div>
    145. 

  145. <div class="line"></div>
    146. 

  146. <div class="line">  Serial.println(<span class="stringliteral">&quot;initialised&quot;</span>);</div>
    147. 

  147. <div class="line">}</div>
    148. 

  148. <div class="line"></div>
    149. 

  149. <div class="line"><span class="comment">// Debugging data dumper</span></div>
    150. 

  150. <div class="line"><span class="keywordtype">void</span> dump(<span class="keywordtype">char</span>* prompt, uint8_t* data, uint8_t len)</div>
    151. 

  151. <div class="line">{</div>
    152. 

  152. <div class="line">  Serial.print(prompt);</div>
    153. 

  153. <div class="line">  Serial.print(<span class="stringliteral">&quot;: &quot;</span>);   </div>
    154. 

  154. <div class="line">  <span class="keywordflow">for</span> (<span class="keywordtype">int</span> i = 0; i &lt; len; i++)</div>
    155. 

  155. <div class="line">  {</div>
    156. 

  156. <div class="line">    Serial.print(data[i], HEX);</div>
    157. 

  157. <div class="line">    Serial.print(<span class="stringliteral">&quot; &quot;</span>);</div>
    158. 

  158. <div class="line">  }</div>
    159. 

  159. <div class="line">  Serial.println(<span class="stringliteral">&quot;&quot;</span>);</div>
    160. 

  160. <div class="line">}</div>
    161. 

  161. <div class="line"></div>
    162. 

  162. <div class="line"><span class="comment">// Send an ACK with a payload on pipe 0</span></div>
    163. 

  163. <div class="line"><span class="keywordtype">void</span> sendAckPayload(uint8_t* data, uint8_t len)</div>
    164. 

  164. <div class="line">{</div>
    165. 

  165. <div class="line">  nrf24.<a name="a10"></a><a class="code" href="classNRF24.html#a01161d0ba54c409e62ad670b9eceb73d">spiBurstWrite</a>(NRF24_COMMAND_W_ACK_PAYLOAD(0), data, len);</div>
    166. 

  166. <div class="line">  nrf24.<a name="a11"></a><a class="code" href="classNRF24.html#a78a011cddedb14b8764ad5ea760c28ae">waitPacketSent</a>();</div>
    167. 

  167. <div class="line">}</div>
    168. 

  168. <div class="line"></div>
    169. 

  169. <div class="line"><span class="comment">// ACK with no payload on pipe 0</span></div>
    170. 

  170. <div class="line"><span class="keywordtype">void</span> sendAck()</div>
    171. 

  171. <div class="line">{</div>
    172. 

  172. <div class="line">  sendAckPayload(0, 0);</div>
    173. 

  173. <div class="line">}</div>
    174. 

  174. <div class="line"></div>
    175. 

  175. <div class="line"><span class="keywordtype">void</span> loop()</div>
    176. 

  176. <div class="line">{</div>
    177. 

  177. <div class="line">  uint8_t buf[100];</div>
    178. 

  178. <div class="line">  uint8_t buflen = <span class="keyword">sizeof</span>(buf);</div>
    179. 

  179. <div class="line">  <span class="keyword">static</span> uint32_t last_second = 0;</div>
    180. 

  180. <div class="line">  </div>
    181. 

  181. <div class="line">  <span class="comment">// enable receiver again, after transmit and wait for a message</span></div>
    182. 

  182. <div class="line">  nrf24.<a name="a12"></a><a class="code" href="classNRF24.html#a5260f3e5eeb911e720290e652f628ab5">waitAvailable</a>();</div>
    183. 

  183. <div class="line">  <span class="keywordflow">if</span> (nrf24.<a name="a13"></a><a class="code" href="classNRF24.html#a12799e0afcb52f2a8cb7418dca9e0eab">recv</a>(buf, &amp;buflen))</div>
    184. 

  184. <div class="line">  {</div>
    185. 

  185. <div class="line">    <span class="comment">// Decode incoming messages from client based on port number in the header byte</span></div>
    186. 

  186. <div class="line"> <span class="comment">//   dump(&quot;msg&quot;, buf, buflen);</span></div>
    187. 

  187. <div class="line">    <span class="keywordflow">if</span> (CRTP_HEADER_PORT(buf[0]) == CRTP_PORT_LINK) <span class="comment">// Link Echo</span></div>
    188. 

  188. <div class="line">    {</div>
    189. 

  189. <div class="line">      sendAck(); <span class="comment">// Just ack, no payload</span></div>
    190. 

  190. <div class="line">    }</div>
    191. 

  191. <div class="line">    <span class="keywordflow">else</span> <span class="keywordflow">if</span> (CRTP_HEADER_PORT(buf[0]) == CRTP_PORT_COMMANDER) <span class="comment">// Commander</span></div>
    192. 

  192. <div class="line">    {</div>
    193. 

  193. <div class="line">      <span class="comment">// Commander message to set control positions</span></div>
    194. 

  194. <div class="line">      CommanderCrtpValues *p = (CommanderCrtpValues*)(buf+1);</div>
    195. 

  195. <div class="line">      Serial.println(p-&gt;roll); <span class="comment">// -30.0 to 30.0</span></div>
    196. 

  196. <div class="line">      Serial.println(p-&gt;pitch); <span class="comment">// -28.0 to 32.0</span></div>
    197. 

  197. <div class="line">      Serial.println(p-&gt;yaw); <span class="comment">// -200.0 to 200.0</span></div>
    198. 

  198. <div class="line">      Serial.println(p-&gt;thrust); <span class="comment">// 0 to 45755</span></div>
    199. 

  199. <div class="line">      sendAck(); <span class="comment">// Just ack, no payload</span></div>
    200. 

  200. <div class="line"><span class="comment">//      dump(&quot;commander&quot;, buf, buflen);</span></div>
    201. 

  201. <div class="line">    }</div>
    202. 

  202. <div class="line">    <span class="keywordflow">else</span> <span class="keywordflow">if</span> (CRTP_HEADER_PORT(buf[0]) == CRTP_PORT_PARAM) <span class="comment">// Parameter</span></div>
    203. 

  203. <div class="line">    {</div>
    204. 

  204. <div class="line">      <span class="keywordflow">if</span> (buf[1] == CMD_GET_INFO) <span class="comment">// Param GET_INFO</span></div>
    205. 

  205. <div class="line">      {</div>
    206. 

  206. <div class="line">        <span class="comment">// pc client only fetches item data if the CRC changes</span></div>
    207. 

  207. <div class="line">        <span class="comment">// If you change the contents of your TOC, you must change the CRC</span></div>
    208. 

  208. <div class="line">        <span class="comment">// Crazyflie PC client doesnt relaly believe it if you say there are no TOC entries</span></div>
    209. 

  209. <div class="line">        uint8_t reply[] = { CRTP_HEADER(CRTP_PORT_PARAM, PARAM_TOC_CH), CMD_GET_INFO, 1, 0, 0, 2, 0}; <span class="comment">// 1 params in toc</span></div>
    210. 

  210. <div class="line">        sendAckPayload(reply, <span class="keyword">sizeof</span>(reply));</div>
    211. 

  211. <div class="line">      }</div>
    212. 

  212. <div class="line">      <span class="keywordflow">else</span> <span class="keywordflow">if</span> (buf[1] == CMD_GET_ITEM) <span class="comment">// Param GET_ITEM</span></div>
    213. 

  213. <div class="line">      { </div>
    214. 

  214. <div class="line">        <span class="comment">// Set up a fax param as item 0</span></div>
    215. 

  215. <div class="line">        uint8_t reply[] = { CRTP_HEADER(CRTP_PORT_PARAM, PARAM_TOC_CH), CMD_GET_ITEM, 0, 1, <span class="charliteral">&#39;x&#39;</span>, 0, <span class="charliteral">&#39;y&#39;</span>, 0}; <span class="comment">// bogus item 0 uint8_t param</span></div>
    216. 

  216. <div class="line">        sendAckPayload(reply, <span class="keyword">sizeof</span>(reply));</div>
    217. 

  217. <div class="line">      }</div>
    218. 

  218. <div class="line">      <span class="keywordflow">else</span></div>
    219. 

  219. <div class="line">      {</div>
    220. 

  220. <div class="line">        Serial.print(<span class="stringliteral">&quot;unknown param type &quot;</span>);</div>
    221. 

  221. <div class="line">        Serial.println(buf[1]);</div>
    222. 

  222. <div class="line">      }</div>
    223. 

  223. <div class="line"> <span class="comment">//     dump(&quot;param&quot;, buf, buflen);</span></div>
    224. 

  224. <div class="line">    }</div>
    225. 

  225. <div class="line">    <span class="keywordflow">else</span> <span class="keywordflow">if</span> (buf[0] == CRTP_HEADER_PORT(buf[0]) == CRTP_PORT_PARAM) <span class="comment">// Log</span></div>
    226. 

  226. <div class="line">    {</div>
    227. 

  227. <div class="line">      <span class="comment">// http://wiki.bitcraze.se/projects:crazyflie:crtp:log</span></div>
    228. 

  228. <div class="line">      <span class="keywordflow">if</span> (buf[1] == CMD_GET_INFO) <span class="comment">// Log GET_INFO</span></div>
    229. 

  229. <div class="line">      {</div>
    230. 

  230. <div class="line">        <span class="comment">// pc client only fetches item data if the CRC changes</span></div>
    231. 

  231. <div class="line">        <span class="comment">// If you change the contents of your TOC, you must change the CRC</span></div>
    232. 

  232. <div class="line">        <span class="comment">// Crazyflie PC client doesnt relaly believe it if you say there are no TOC entries</span></div>
    233. 

  233. <div class="line">       uint8_t reply[] = { CRTP_HEADER(CRTP_PORT_LOG, LOG_TOC_CH), CMD_GET_INFO, 1, 0, 0, 2, 1, 8, 64}; <span class="comment">// 1 log item in toc</span></div>
    234. 

  234. <div class="line">        sendAckPayload(reply, <span class="keyword">sizeof</span>(reply));</div>
    235. 

  235. <div class="line">      }   </div>
    236. 

  236. <div class="line">      <span class="keywordflow">else</span> <span class="keywordflow">if</span> (buf[1] == CMD_GET_ITEM) <span class="comment">// Log GET_ITEM</span></div>
    237. 

  237. <div class="line">      {</div>
    238. 

  238. <div class="line">        <span class="comment">// Set up a fake battery voltage as item 0</span></div>
    239. 

  239. <div class="line">        uint8_t reply[] = { CRTP_HEADER(CRTP_PORT_LOG, LOG_TOC_CH), CMD_GET_ITEM, 0, 7, <span class="charliteral">&#39;p&#39;</span>, <span class="charliteral">&#39;m&#39;</span>, 0, <span class="charliteral">&#39;v&#39;</span>, <span class="charliteral">&#39;b&#39;</span>, <span class="charliteral">&#39;a&#39;</span>, <span class="charliteral">&#39;t&#39;</span>, 0}; <span class="comment">// item 0 float pm.vbat</span></div>
    240. 

  240. <div class="line">        sendAckPayload(reply, <span class="keyword">sizeof</span>(reply));</div>
    241. 

  241. <div class="line">      }</div>
    242. 

  242. <div class="line"><span class="comment">//      dump(&quot;log&quot;, buf, buflen);</span></div>
    243. 

  243. <div class="line">    }</div>
    244. 

  244. <div class="line">    <span class="keywordflow">else</span></div>
    245. 

  245. <div class="line">    {</div>
    246. 

  246. <div class="line">      <span class="comment">// Sometimes get bogus type 0x93</span></div>
    247. 

  247. <div class="line"> <span class="comment">//     dump(&quot;unknown&quot;, buf, buflen);</span></div>
    248. 

  248. <div class="line">    }</div>
    249. 

  249. <div class="line">  }</div>
    250. 

  250. <div class="line">  </div>
    251. 

  251. <div class="line">  <span class="comment">// Do once per second tasks</span></div>
    252. 

  252. <div class="line">  uint32_t this_second = millis() / 1000;</div>
    253. 

  253. <div class="line">  <span class="keywordflow">if</span> (this_second != last_second)</div>
    254. 

  254. <div class="line">  {</div>
    255. 

  255. <div class="line">    <span class="comment">// This is how you would send value data for a log block</span></div>
    256. 

  256. <div class="line">    <span class="comment">// with current real-time data</span></div>
    257. 

  257. <div class="line">    <span class="comment">// if a log block has ben set up by the client</span></div>
    258. 

  258. <div class="line"><span class="comment">//    uint8_t msg[] = {CRTP_HEADER(CRTP_PORT_LOG, LOG_LOG_CH), 0, 0, 0, 0, 11, 11, 11, 11};</span></div>
    259. 

  259. <div class="line"><span class="comment">//    sendAckPayload(msg, sizeof(msg));</span></div>
    260. 

  260. <div class="line"></div>
    261. 

  261. <div class="line">    last_second = this_second;</div>
    262. 

  262. <div class="line">  }</div>
    263. 

  263. <div class="line">}</div>
    264. 

  264. <div class="line"></div>
    265. 

  265. </div><!-- fragment --> </div><!-- contents -->
    266. 

  266. <!-- start footer part -->
    267. 

  267. <hr class="footer"/><address class="footer"><small>
    268. 

  268. Generated by &#160;<a href="http://www.doxygen.org/index.html">
    269. 

  269. <img class="footer" src="doxygen.png" alt="doxygen"/>
    270. 

  270. </a> 1.8.5
    271. 

  271. </small></address>
    272. 

  272. </body>
    273. 

  273. </html>
    274.