<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd"> <html xmlns="http://www.w3.org/1999/xhtml"> <head> <meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/> <title>libnfc: nfc-emulate-uid.c Source File</title> <link href="tabs.css" rel="stylesheet" type="text/css"/> <link href="doxygen.css" rel="stylesheet" type="text/css"/> </head> <body> <!-- Generated by Doxygen 1.7.3 --> <div id="top"> <div id="titlearea"> <table cellspacing="0" cellpadding="0"> <tbody> <tr style="height: 56px;"> <td style="padding-left: 0.5em;"> <div id="projectname">libnfc <span id="projectnumber">1.4.2</span></div> </td> </tr> </tbody> </table> </div> <div id="navrow1" class="tabs"> <ul class="tablist"> <li><a href="index.html"><span>Main Page</span></a></li> <li><a href="annotated.html"><span>Data Structures</span></a></li> <li class="current"><a href="files.html"><span>Files</span></a></li> <li><a href="dirs.html"><span>Directories</span></a></li> </ul> </div> <div id="navrow2" class="tabs2"> <ul class="tablist"> <li><a href="files.html"><span>File List</span></a></li> <li><a href="globals.html"><span>Globals</span></a></li> </ul> </div> <div id="nav-path" class="navpath"> <ul> <li class="navelem"><a class="el" href="dir_e1066e20c97c3d492c10ec6dd00ee654.html">examples</a> </li> </ul> </div> </div> <div class="header"> <div class="headertitle"> <h1>nfc-emulate-uid.c</h1> </div> </div> <div class="contents"> <a href="nfc-emulate-uid_8c.html">Go to the documentation of this file.</a><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001 <span class="comment">/*-</span> <a name="l00002"></a>00002 <span class="comment"> * Public platform independent Near Field Communication (NFC) library examples</span> <a name="l00003"></a>00003 <span class="comment"> * </span> <a name="l00004"></a>00004 <span class="comment"> * Copyright (C) 2009, Roel Verdult</span> <a name="l00005"></a>00005 <span class="comment"> * Copyright (C) 2010, Romuald Conty</span> <a name="l00006"></a>00006 <span class="comment"> * </span> <a name="l00007"></a>00007 <span class="comment"> * Redistribution and use in source and binary forms, with or without</span> <a name="l00008"></a>00008 <span class="comment"> * modification, are permitted provided that the following conditions are met:</span> <a name="l00009"></a>00009 <span class="comment"> * 1) Redistributions of source code must retain the above copyright notice,</span> <a name="l00010"></a>00010 <span class="comment"> * this list of conditions and the following disclaimer. </span> <a name="l00011"></a>00011 <span class="comment"> * 2 )Redistributions in binary form must reproduce the above copyright</span> <a name="l00012"></a>00012 <span class="comment"> * notice, this list of conditions and the following disclaimer in the</span> <a name="l00013"></a>00013 <span class="comment"> * documentation and/or other materials provided with the distribution.</span> <a name="l00014"></a>00014 <span class="comment"> *</span> <a name="l00015"></a>00015 <span class="comment"> * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"</span> <a name="l00016"></a>00016 <span class="comment"> * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE</span> <a name="l00017"></a>00017 <span class="comment"> * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE</span> <a name="l00018"></a>00018 <span class="comment"> * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE</span> <a name="l00019"></a>00019 <span class="comment"> * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR</span> <a name="l00020"></a>00020 <span class="comment"> * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF</span> <a name="l00021"></a>00021 <span class="comment"> * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS</span> <a name="l00022"></a>00022 <span class="comment"> * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN</span> <a name="l00023"></a>00023 <span class="comment"> * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)</span> <a name="l00024"></a>00024 <span class="comment"> * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE</span> <a name="l00025"></a>00025 <span class="comment"> * POSSIBILITY OF SUCH DAMAGE.</span> <a name="l00026"></a>00026 <span class="comment"> * </span> <a name="l00027"></a>00027 <span class="comment"> * Note that this license only applies on the examples, NFC library itself is under LGPL</span> <a name="l00028"></a>00028 <span class="comment"> *</span> <a name="l00029"></a>00029 <span class="comment"> */</span> <a name="l00030"></a>00030 <a name="l00042"></a>00042 <span class="preprocessor">#ifdef HAVE_CONFIG_H</span> <a name="l00043"></a>00043 <span class="preprocessor"></span><span class="preprocessor"># include "config.h"</span> <a name="l00044"></a>00044 <span class="preprocessor">#endif // HAVE_CONFIG_H</span> <a name="l00045"></a>00045 <span class="preprocessor"></span> <a name="l00046"></a>00046 <span class="preprocessor">#include <stdio.h></span> <a name="l00047"></a>00047 <span class="preprocessor">#include <stdlib.h></span> <a name="l00048"></a>00048 <span class="preprocessor">#include <stddef.h></span> <a name="l00049"></a>00049 <span class="preprocessor">#include <stdint.h></span> <a name="l00050"></a>00050 <span class="preprocessor">#include <string.h></span> <a name="l00051"></a>00051 <span class="preprocessor">#include <signal.h></span> <a name="l00052"></a>00052 <a name="l00053"></a>00053 <span class="preprocessor">#include <nfc/nfc.h></span> <a name="l00054"></a>00054 <a name="l00055"></a>00055 <span class="preprocessor">#include <nfc/nfc-messages.h></span> <a name="l00056"></a>00056 <span class="preprocessor">#include "<a class="code" href="nfc-utils_8h.html" title="Provide some examples shared functions like print, parity calculation, options parsing.">nfc-utils.h</a>"</span> <a name="l00057"></a>00057 <a name="l00058"></a>00058 <span class="preprocessor">#define MAX_FRAME_LEN 264</span> <a name="l00059"></a>00059 <span class="preprocessor"></span> <a name="l00060"></a>00060 <span class="keyword">static</span> byte_t abtRecv[MAX_FRAME_LEN]; <a name="l00061"></a>00061 <span class="keyword">static</span> <span class="keywordtype">size_t</span> szRecvBits; <a name="l00062"></a>00062 <span class="keyword">static</span> <a class="code" href="structnfc__device__t.html" title="NFC device information.">nfc_device_t</a> *pnd; <a name="l00063"></a>00063 <a name="l00064"></a>00064 <span class="comment">// ISO14443A Anti-Collision response</span> <a name="l00065"></a>00065 byte_t abtAtqa[2] = { 0x04, 0x00 }; <a name="l00066"></a>00066 byte_t abtUidBcc[5] = { 0xDE, 0xAD, 0xBE, 0xEF, 0x62 }; <a name="l00067"></a>00067 byte_t abtSak[9] = { 0x08, 0xb6, 0xdd }; <a name="l00068"></a>00068 <a name="l00069"></a>00069 <span class="keywordtype">void</span> <a name="l00070"></a>00070 intr_hdlr (<span class="keywordtype">void</span>) <a name="l00071"></a>00071 { <a name="l00072"></a>00072 printf (<span class="stringliteral">"\nQuitting...\n"</span>); <a name="l00073"></a>00073 <span class="keywordflow">if</span> (pnd != NULL) { <a name="l00074"></a>00074 <a class="code" href="nfc_8c.html#a442dc68878c3a0bb7e3293c8fd96afb0" title="Disconnect from a NFC device.">nfc_disconnect</a>(pnd); <a name="l00075"></a>00075 } <a name="l00076"></a>00076 exit (EXIT_FAILURE); <a name="l00077"></a>00077 } <a name="l00078"></a>00078 <a name="l00079"></a>00079 <span class="keywordtype">void</span> <a name="l00080"></a>00080 print_usage (<span class="keywordtype">char</span> *argv[]) <a name="l00081"></a>00081 { <a name="l00082"></a>00082 printf (<span class="stringliteral">"Usage: %s [OPTIONS] [UID]\n"</span>, argv[0]); <a name="l00083"></a>00083 printf (<span class="stringliteral">"Options:\n"</span>); <a name="l00084"></a>00084 printf (<span class="stringliteral">"\t-h\tHelp. Print this message.\n"</span>); <a name="l00085"></a>00085 printf (<span class="stringliteral">"\t-q\tQuiet mode. Silent output: received and sent frames will not be shown (improves timing).\n"</span>); <a name="l00086"></a>00086 printf (<span class="stringliteral">"\n"</span>); <a name="l00087"></a>00087 printf (<span class="stringliteral">"\t[UID]\tUID to emulate, specified as 8 HEX digits (default is DEADBEEF).\n"</span>); <a name="l00088"></a>00088 } <a name="l00089"></a>00089 <a name="l00090"></a>00090 <span class="keywordtype">int</span> <a name="l00091"></a>00091 main (<span class="keywordtype">int</span> argc, <span class="keywordtype">char</span> *argv[]) <a name="l00092"></a>00092 { <a name="l00093"></a>00093 byte_t *pbtTx = NULL; <a name="l00094"></a>00094 <span class="keywordtype">size_t</span> szTxBits; <a name="l00095"></a>00095 <span class="keywordtype">bool</span> quiet_output = <span class="keyword">false</span>; <a name="l00096"></a>00096 <a name="l00097"></a>00097 <span class="keywordtype">int</span> arg, <a name="l00098"></a>00098 i; <a name="l00099"></a>00099 <a name="l00100"></a>00100 <span class="comment">// Get commandline options</span> <a name="l00101"></a>00101 <span class="keywordflow">for</span> (arg = 1; arg < argc; arg++) { <a name="l00102"></a>00102 <span class="keywordflow">if</span> (0 == strcmp (argv[arg], <span class="stringliteral">"-h"</span>)) { <a name="l00103"></a>00103 print_usage (argv); <a name="l00104"></a>00104 exit(EXIT_SUCCESS); <a name="l00105"></a>00105 } <span class="keywordflow">else</span> <span class="keywordflow">if</span> (0 == strcmp (argv[arg], <span class="stringliteral">"-q"</span>)) { <a name="l00106"></a>00106 printf (<span class="stringliteral">"Quiet mode.\n"</span>); <a name="l00107"></a>00107 quiet_output = <span class="keyword">true</span>; <a name="l00108"></a>00108 } <span class="keywordflow">else</span> <span class="keywordflow">if</span> ((arg == argc - 1) && (strlen (argv[arg]) == 8)) { <span class="comment">// See if UID was specified as HEX string</span> <a name="l00109"></a>00109 byte_t abtTmp[3] = { 0x00, 0x00, 0x00 }; <a name="l00110"></a>00110 printf (<span class="stringliteral">"[+] Using UID: %s\n"</span>, argv[arg]); <a name="l00111"></a>00111 abtUidBcc[4] = 0x00; <a name="l00112"></a>00112 <span class="keywordflow">for</span> (i = 0; i < 4; ++i) { <a name="l00113"></a>00113 memcpy (abtTmp, argv[arg] + i * 2, 2); <a name="l00114"></a>00114 abtUidBcc[i] = (byte_t) strtol ((<span class="keywordtype">char</span> *) abtTmp, NULL, 16); <a name="l00115"></a>00115 abtUidBcc[4] ^= abtUidBcc[i]; <a name="l00116"></a>00116 } <a name="l00117"></a>00117 } <span class="keywordflow">else</span> { <a name="l00118"></a>00118 ERR (<span class="stringliteral">"%s is not supported option."</span>, argv[arg]); <a name="l00119"></a>00119 print_usage (argv); <a name="l00120"></a>00120 exit(EXIT_FAILURE); <a name="l00121"></a>00121 } <a name="l00122"></a>00122 } <a name="l00123"></a>00123 <a name="l00124"></a>00124 <span class="preprocessor">#ifdef WIN32</span> <a name="l00125"></a>00125 <span class="preprocessor"></span> signal (SIGINT, (<span class="keywordtype">void</span> (__cdecl *) (<span class="keywordtype">int</span>)) intr_hdlr); <a name="l00126"></a>00126 <span class="preprocessor">#else</span> <a name="l00127"></a>00127 <span class="preprocessor"></span> signal (SIGINT, (<span class="keywordtype">void</span> (*)()) intr_hdlr); <a name="l00128"></a>00128 <span class="preprocessor">#endif</span> <a name="l00129"></a>00129 <span class="preprocessor"></span> <a name="l00130"></a>00130 <span class="comment">// Try to open the NFC device</span> <a name="l00131"></a>00131 pnd = <a class="code" href="nfc_8c.html#aff0c2c92d2fc81e5dc93150fc72a7de6" title="Connect to a NFC device.">nfc_connect</a> (NULL); <a name="l00132"></a>00132 <a name="l00133"></a>00133 <span class="keywordflow">if</span> (pnd == NULL) { <a name="l00134"></a>00134 printf (<span class="stringliteral">"Unable to connect to NFC device\n"</span>); <a name="l00135"></a>00135 exit(EXIT_FAILURE); <a name="l00136"></a>00136 } <a name="l00137"></a>00137 <a name="l00138"></a>00138 printf (<span class="stringliteral">"\n"</span>); <a name="l00139"></a>00139 printf (<span class="stringliteral">"Connected to NFC device: %s\n"</span>, pnd-><a class="code" href="structnfc__device__t.html#a3933f0bea196fedca0345a7f940dc85b">acName</a>); <a name="l00140"></a>00140 printf (<span class="stringliteral">"[+] Try to break out the auto-emulation, this requires a second NFC device!\n"</span>); <a name="l00141"></a>00141 printf (<span class="stringliteral">"[+] To do this, please send any command after the anti-collision\n"</span>); <a name="l00142"></a>00142 printf (<span class="stringliteral">"[+] For example, send a RATS command or use the \"nfc-anticol\" or \"nfc-list\" tool.\n"</span>); <a name="l00143"></a>00143 <a name="l00144"></a>00144 <span class="comment">// Note: We have to build a "fake" nfc_target_t in order to do exactly the same that was done before the new nfc_target_init() was introduced.</span> <a name="l00145"></a>00145 <a class="code" href="structnfc__target__t.html" title="NFC target structure.">nfc_target_t</a> nt = { <a name="l00146"></a>00146 .nm.nmt = NMT_ISO14443A, <a name="l00147"></a>00147 .nm.nbr = NBR_UNDEFINED, <a name="l00148"></a>00148 .nti.nai.abtAtqa = { 0x04, 0x00 }, <a name="l00149"></a>00149 .nti.nai.abtUid = { 0x08, 0xad, 0xbe, 0xef }, <a name="l00150"></a>00150 .nti.nai.btSak = 0x20, <a name="l00151"></a>00151 .nti.nai.szUidLen = 4, <a name="l00152"></a>00152 .nti.nai.szAtsLen = 0, <a name="l00153"></a>00153 }; <a name="l00154"></a>00154 <span class="keywordflow">if</span> (!<a class="code" href="nfc_8c.html#a2e021479b99fbd60cf5f037b2daa3007" title="Initialize NFC device as an emulated tag.">nfc_target_init</a> (pnd, &nt, abtRecv, &szRecvBits)) { <a name="l00155"></a>00155 <a class="code" href="nfc_8c.html#a111b9182fc80b309b56009e9c6be7454" title="Display the PCD error a-la perror.">nfc_perror</a> (pnd, <span class="stringliteral">"nfc_target_init"</span>); <a name="l00156"></a>00156 ERR (<span class="stringliteral">"Could not come out of auto-emulation, no command was received"</span>); <a name="l00157"></a>00157 exit(EXIT_FAILURE); <a name="l00158"></a>00158 } <a name="l00159"></a>00159 printf (<span class="stringliteral">"[+] Received initiator command: "</span>); <a name="l00160"></a>00160 print_hex_bits (abtRecv, szRecvBits); <a name="l00161"></a>00161 printf (<span class="stringliteral">"[+] Configuring communication\n"</span>); <a name="l00162"></a>00162 <span class="keywordflow">if</span> (!<a class="code" href="nfc_8c.html#a6cd940508b34b99c6c94173f8300d069" title="Configure advanced NFC device settings.">nfc_configure</a> (pnd, <a class="code" href="nfc-types_8h.html#ab2cdef5e5ac453e9c60c9fe449cb311ea34588e4870fcc10476151e27e8e97a74">NDO_HANDLE_CRC</a>, <span class="keyword">false</span>) || !<a class="code" href="nfc_8c.html#a6cd940508b34b99c6c94173f8300d069" title="Configure advanced NFC device settings.">nfc_configure</a> (pnd, <a class="code" href="nfc-types_8h.html#ab2cdef5e5ac453e9c60c9fe449cb311ea7c1f6097b2d2a1670f580de332c41596">NDO_HANDLE_PARITY</a>, <span class="keyword">true</span>)) { <a name="l00163"></a>00163 <a class="code" href="nfc_8c.html#a111b9182fc80b309b56009e9c6be7454" title="Display the PCD error a-la perror.">nfc_perror</a> (pnd, <span class="stringliteral">"nfc_configure"</span>); <a name="l00164"></a>00164 exit (EXIT_FAILURE); <a name="l00165"></a>00165 } <a name="l00166"></a>00166 printf (<span class="stringliteral">"[+] Done, the emulated tag is initialized with UID: %02X%02X%02X%02X\n\n"</span>, abtUidBcc[0], abtUidBcc[1], <a name="l00167"></a>00167 abtUidBcc[2], abtUidBcc[3]); <a name="l00168"></a>00168 <a name="l00169"></a>00169 <span class="keywordflow">while</span> (<span class="keyword">true</span>) { <a name="l00170"></a>00170 <span class="comment">// Test if we received a frame</span> <a name="l00171"></a>00171 <span class="keywordflow">if</span> (<a class="code" href="nfc_8c.html#a655c79686ca6d03e788cd81eed3c69f1" title="Receive bit-frames.">nfc_target_receive_bits</a> (pnd, abtRecv, &szRecvBits, NULL)) { <a name="l00172"></a>00172 <span class="comment">// Prepare the command to send back for the anti-collision request</span> <a name="l00173"></a>00173 <span class="keywordflow">switch</span> (szRecvBits) { <a name="l00174"></a>00174 <span class="keywordflow">case</span> 7: <span class="comment">// Request or Wakeup</span> <a name="l00175"></a>00175 pbtTx = abtAtqa; <a name="l00176"></a>00176 szTxBits = 16; <a name="l00177"></a>00177 <span class="comment">// New anti-collsion session started</span> <a name="l00178"></a>00178 <span class="keywordflow">if</span> (!quiet_output) <a name="l00179"></a>00179 printf (<span class="stringliteral">"\n"</span>); <a name="l00180"></a>00180 <span class="keywordflow">break</span>; <a name="l00181"></a>00181 <a name="l00182"></a>00182 <span class="keywordflow">case</span> 16: <span class="comment">// Select All</span> <a name="l00183"></a>00183 pbtTx = abtUidBcc; <a name="l00184"></a>00184 szTxBits = 40; <a name="l00185"></a>00185 <span class="keywordflow">break</span>; <a name="l00186"></a>00186 <a name="l00187"></a>00187 <span class="keywordflow">case</span> 72: <span class="comment">// Select Tag</span> <a name="l00188"></a>00188 pbtTx = abtSak; <a name="l00189"></a>00189 szTxBits = 24; <a name="l00190"></a>00190 <span class="keywordflow">break</span>; <a name="l00191"></a>00191 <a name="l00192"></a>00192 <span class="keywordflow">default</span>: <span class="comment">// unknown length?</span> <a name="l00193"></a>00193 szTxBits = 0; <a name="l00194"></a>00194 <span class="keywordflow">break</span>; <a name="l00195"></a>00195 } <a name="l00196"></a>00196 <a name="l00197"></a>00197 <span class="keywordflow">if</span> (!quiet_output) { <a name="l00198"></a>00198 printf (<span class="stringliteral">"R: "</span>); <a name="l00199"></a>00199 print_hex_bits (abtRecv, szRecvBits); <a name="l00200"></a>00200 } <a name="l00201"></a>00201 <span class="comment">// Test if we know how to respond</span> <a name="l00202"></a>00202 <span class="keywordflow">if</span> (szTxBits) { <a name="l00203"></a>00203 <span class="comment">// Send and print the command to the screen</span> <a name="l00204"></a>00204 <span class="keywordflow">if</span> (!<a class="code" href="nfc_8c.html#a13e7015472f2385e1f3a46ddfe95f980" title="Send raw bit-frames.">nfc_target_send_bits</a> (pnd, pbtTx, szTxBits, NULL)) { <a name="l00205"></a>00205 <a class="code" href="nfc_8c.html#a111b9182fc80b309b56009e9c6be7454" title="Display the PCD error a-la perror.">nfc_perror</a> (pnd, <span class="stringliteral">"nfc_target_send_bits"</span>); <a name="l00206"></a>00206 exit (EXIT_FAILURE); <a name="l00207"></a>00207 } <a name="l00208"></a>00208 <span class="keywordflow">if</span> (!quiet_output) { <a name="l00209"></a>00209 printf (<span class="stringliteral">"T: "</span>); <a name="l00210"></a>00210 print_hex_bits (pbtTx, szTxBits); <a name="l00211"></a>00211 } <a name="l00212"></a>00212 } <a name="l00213"></a>00213 } <a name="l00214"></a>00214 } <a name="l00215"></a>00215 <a name="l00216"></a>00216 <a class="code" href="nfc_8c.html#a442dc68878c3a0bb7e3293c8fd96afb0" title="Disconnect from a NFC device.">nfc_disconnect</a> (pnd); <a name="l00217"></a>00217 exit (EXIT_SUCCESS); <a name="l00218"></a>00218 } </pre></div></div> </div> <hr class="footer"/><address class="footer"><small>Generated on Wed Feb 23 2011 for libnfc by  <a href="http://www.doxygen.org/index.html"> <img class="footer" src="doxygen.png" alt="doxygen"/></a> 1.7.3 </small></address> </body> </html>