• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Copyright (C) 2010 NXP Semiconductors
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  *      http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16 
17 /*!
18 * =========================================================================== *
19 *                                                                             *
20 *                                                                             *
21 * \file  phHciNfc_RFReaderA.c                                                 *
22 * \brief HCI Reader A Management Routines.                                    *
23 *                                                                             *
24 *                                                                             *
25 * Project: NFC-FRI-1.1                                                        *
26 *                                                                             *
27 * $Date: Wed Feb 17 16:19:04 2010 $                                           *
28 * $Author: ing02260 $                                                         *
29 * $Revision: 1.57 $                                                           *
30 * $Aliases: NFC_FRI1.1_WK1007_R33_1,NFC_FRI1.1_WK1007_R33_4,NFC_FRI1.1_WK1017_PREP1,NFC_FRI1.1_WK1017_R34_1,NFC_FRI1.1_WK1017_R34_2,NFC_FRI1.1_WK1023_R35_1 $
31 *                                                                             *
32 * =========================================================================== *
33 */
34 
35 /*
36 ***************************** Header File Inclusion ****************************
37 */
38 #include <phNfcCompId.h>
39 #include <phHciNfc_Pipe.h>
40 #include <phHciNfc_RFReader.h>
41 #include <phHciNfc_RFReaderA.h>
42 #include <phOsalNfc.h>
43 /*
44 ****************************** Macro Definitions *******************************
45 */
46 
47 /* Registry used for getting the data */
48 #define RDR_A_DATA_RATE_MAX_INDEX           0x01U
49 #define RDR_A_UID_INDEX                     0x02U
50 #define RDR_A_SAK_INDEX                     0x03U
51 #define RDR_A_ATQA_INDEX                    0x04U
52 #define RDR_A_APP_DATA_INDEX                0x05U
53 #define RDR_A_FWI_SFGT_INDEX                0x06U
54 
55 /* Registry index for auto activation */
56 #define NXP_AUTO_ACTIVATION_INDEX           0x10U
57 
58 #define RDR_A_SAK_FWI_SFGT_LENGTH           0x01U
59 
60 #define RDR_A_SINGLE_TAG_FOUND              0x00U
61 #define RDR_A_MULTIPLE_TAGS_FOUND           0x03U
62 
63 #define RDR_A_MAX_APP_DATA_LEN              0x30U
64 
65 /* Time out */
66 #define RDR_A_MIFARE_STATUS                 0x00U
67 
68 #define RDR_A_MIFARE_RAW_LENGTH             0x03U
69 
70 uint8_t nxp_nfc_mifareraw_timeout = NXP_MIFARE_XCHG_TIMEOUT;
71 /*
72 *************************** Structure and Enumeration ***************************
73 */
74 
75 
76 /*
77 *************************** Static Function Declaration **************************
78 */
79 
80 static
81 NFCSTATUS
82 phHciNfc_Recv_ReaderA_Response(
83                         void                *psContext,
84                         void                *pHwRef,
85                         uint8_t             *pResponse,
86 #ifdef ONE_BYTE_LEN
87                         uint8_t             length
88 #else
89                         uint16_t            length
90 #endif
91                        );
92 
93 static
94 NFCSTATUS
95 phHciNfc_Recv_ReaderA_Event(
96                              void               *psContext,
97                              void               *pHwRef,
98                              uint8_t            *pEvent,
99 #ifdef ONE_BYTE_LEN
100                              uint8_t            length
101 #else
102                              uint16_t           length
103 #endif
104                        );
105 
106 static
107 NFCSTATUS
108 phHciNfc_ReaderA_InfoUpdate(
109                             phHciNfc_sContext_t     *psHciContext,
110                             uint8_t                 index,
111                             uint8_t                 *reg_value,
112                             uint8_t                 reg_length
113                          );
114 
115 static
116 NFCSTATUS
117 phHciNfc_Recv_Mifare_Packet(
118                             phHciNfc_sContext_t *psHciContext,
119                             uint8_t             cmd,
120                             uint8_t             *pResponse,
121 #ifdef ONE_BYTE_LEN
122                             uint8_t             length
123 #else
124                             uint16_t            length
125 #endif
126                             );
127 
128 static
129 NFCSTATUS
130 phHciNfc_Recv_Iso_A_Packet(
131                            phHciNfc_sContext_t  *psHciContext,
132                            uint8_t              *pResponse,
133 #ifdef ONE_BYTE_LEN
134                             uint8_t             length
135 #else
136                             uint16_t            length
137 #endif
138                            );
139 /*
140 *************************** Function Definitions ***************************
141 */
142 NFCSTATUS
phHciNfc_ReaderA_Get_PipeID(phHciNfc_sContext_t * psHciContext,uint8_t * ppipe_id)143 phHciNfc_ReaderA_Get_PipeID(
144                              phHciNfc_sContext_t        *psHciContext,
145                              uint8_t                    *ppipe_id
146                              )
147 {
148     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
149 
150     if( (NULL != psHciContext)
151         && ( NULL != ppipe_id )
152         && ( NULL != psHciContext->p_reader_a_info )
153         )
154     {
155         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
156         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
157             psHciContext->p_reader_a_info ;
158         *ppipe_id =  p_rdr_a_info->pipe_id  ;
159     }
160     else
161     {
162         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
163     }
164     return status;
165 }
166 
167 
168 NFCSTATUS
phHciNfc_ReaderA_Init_Resources(phHciNfc_sContext_t * psHciContext)169 phHciNfc_ReaderA_Init_Resources(
170                                 phHciNfc_sContext_t     *psHciContext
171                          )
172 {
173     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
174     phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
175     if( NULL == psHciContext )
176     {
177         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
178     }
179     else
180     {
181         if(
182             ( NULL == psHciContext->p_reader_a_info ) &&
183              (phHciNfc_Allocate_Resource((void **)(&p_rdr_a_info),
184             sizeof(phHciNfc_ReaderA_Info_t))== NFCSTATUS_SUCCESS)
185           )
186         {
187             psHciContext->p_reader_a_info = p_rdr_a_info;
188             p_rdr_a_info->current_seq = RDR_A_INVALID_SEQ;
189             p_rdr_a_info->next_seq = RDR_A_INVALID_SEQ;
190             p_rdr_a_info->pipe_id = (uint8_t)HCI_UNKNOWN_PIPE_ID;
191         }
192         else
193         {
194             status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INSUFFICIENT_RESOURCES);
195         }
196 
197     }
198     return status;
199 }
200 
201 NFCSTATUS
phHciNfc_ReaderA_Update_PipeInfo(phHciNfc_sContext_t * psHciContext,uint8_t pipeID,phHciNfc_Pipe_Info_t * pPipeInfo)202 phHciNfc_ReaderA_Update_PipeInfo(
203                                   phHciNfc_sContext_t     *psHciContext,
204                                   uint8_t                 pipeID,
205                                   phHciNfc_Pipe_Info_t    *pPipeInfo
206                                   )
207 {
208     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
209 
210     if( NULL == psHciContext )
211     {
212         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
213     }
214     else if(NULL == psHciContext->p_reader_a_info)
215     {
216         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
217     }
218     else
219     {
220         phHciNfc_ReaderA_Info_t *p_rdr_a_info=NULL;
221         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
222                                 psHciContext->p_reader_a_info ;
223         /* Update the pipe_id of the reader A Gate obtained from the HCI Response */
224         p_rdr_a_info->pipe_id = pipeID;
225         p_rdr_a_info->p_pipe_info = pPipeInfo;
226         if (NULL != pPipeInfo)
227         {
228             /* Update the Response Receive routine of the reader A Gate */
229             pPipeInfo->recv_resp = &phHciNfc_Recv_ReaderA_Response;
230             /* Update the event Receive routine of the reader A Gate */
231             pPipeInfo->recv_event = &phHciNfc_Recv_ReaderA_Event;
232         }
233     }
234 
235     return status;
236 }
237 
238 NFCSTATUS
phHciNfc_ReaderA_Info_Sequence(void * psHciHandle,void * pHwRef)239 phHciNfc_ReaderA_Info_Sequence (
240                        void             *psHciHandle,
241                        void             *pHwRef
242                        )
243 {
244     NFCSTATUS               status = NFCSTATUS_SUCCESS;
245     phHciNfc_sContext_t     *psHciContext = ((phHciNfc_sContext_t *)psHciHandle);
246 
247     HCI_PRINT ("HCI : phHciNfc_ReaderA_Info_Sequence called... \n");
248     if( (NULL == psHciContext)
249         || (NULL == pHwRef)
250       )
251     {
252       status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
253     }
254     else if((NULL == psHciContext->p_reader_a_info) ||
255         (HCI_READER_A_ENABLE !=
256         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
257         enable_rdr_a_gate))
258     {
259         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
260     }
261     else
262     {
263         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
264         phHciNfc_Pipe_Info_t        *p_pipe_info=NULL;
265         uint8_t                     pipeid = 0;
266 
267         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
268                                 psHciContext->p_reader_a_info ;
269         p_pipe_info = p_rdr_a_info->p_pipe_info;
270         if(NULL == p_pipe_info )
271         {
272             status = PHNFCSTVAL(CID_NFC_HCI,
273                             NFCSTATUS_INVALID_HCI_SEQUENCE);
274         }
275         else
276         {
277             HCI_DEBUG ("HCI : p_rdr_a_info->current_seq : %02X\n", p_rdr_a_info->current_seq);
278             switch(p_rdr_a_info->current_seq)
279             {
280                 case RDR_A_UID:
281                 {
282                     p_pipe_info->reg_index = RDR_A_UID_INDEX;
283                     pipeid = p_rdr_a_info->pipe_id ;
284                     /* Fill the data buffer and send the command to the
285                             device */
286                     status =
287                         phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
288                         pipeid, (uint8_t)ANY_GET_PARAMETER);
289                     if(NFCSTATUS_PENDING == status )
290                     {
291                         p_rdr_a_info->next_seq = RDR_A_SAK;
292                     }
293                     break;
294                 }
295                 case RDR_A_SAK:
296                 {
297                     p_pipe_info->reg_index = RDR_A_SAK_INDEX;
298                     pipeid = p_rdr_a_info->pipe_id ;
299                     /* Fill the data buffer and send the command to the
300                             device */
301                     status =
302                         phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
303                         pipeid, (uint8_t)ANY_GET_PARAMETER);
304                     if(NFCSTATUS_PENDING == status )
305                     {
306                         p_rdr_a_info->next_seq = RDR_A_ATQA;
307                     }
308                     break;
309                 }
310                 case RDR_A_ATQA:
311                 {
312                     p_pipe_info->reg_index = RDR_A_ATQA_INDEX;
313                     pipeid = p_rdr_a_info->pipe_id ;
314                     /* Fill the data buffer and send the command to the
315                             device */
316                     status =
317                         phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
318                         pipeid, (uint8_t)ANY_GET_PARAMETER);
319                     if(NFCSTATUS_PENDING == status )
320                     {
321                         p_rdr_a_info->next_seq = RDR_A_END_SEQUENCE;
322                     }
323                     break;
324                 }
325                 case RDR_A_END_SEQUENCE:
326                 {
327                     phNfc_sCompletionInfo_t     CompInfo;
328                     if (RDR_A_MULTIPLE_TAGS_FOUND ==
329                         p_rdr_a_info->multiple_tgts_found)
330                     {
331                         CompInfo.status = NFCSTATUS_MULTIPLE_TAGS;
332                     }
333                     else
334                     {
335                         CompInfo.status = NFCSTATUS_SUCCESS;
336                     }
337 
338                     CompInfo.info = &(p_rdr_a_info->reader_a_info);
339 
340                     p_rdr_a_info->reader_a_info.RemDevType = phHal_eISO14443_A_PICC;
341                     p_rdr_a_info->current_seq = RDR_A_UID;
342                     p_rdr_a_info->next_seq = RDR_A_UID;
343                     status = NFCSTATUS_SUCCESS;
344                     HCI_DEBUG ("HCI : p_rdr_a_info->reader_a_info.RemDevType : %02X\n", p_rdr_a_info->reader_a_info.RemDevType);
345                     HCI_DEBUG ("HCI : status notified: %02X\n", CompInfo.status);
346                     /* Notify to the upper layer */
347                     phHciNfc_Tag_Notify(psHciContext,
348                         pHwRef,
349                         NFC_NOTIFY_TARGET_DISCOVERED,
350                         &CompInfo);
351                     break;
352                 }
353                 default:
354                 {
355                     status = PHNFCSTVAL(CID_NFC_HCI,
356                                     NFCSTATUS_INVALID_HCI_RESPONSE);
357                     break;
358                 }
359             }
360             HCI_DEBUG ("HCI : p_rdr_a_info->current_seq after : %02X\n", p_rdr_a_info->current_seq);
361             HCI_DEBUG ("HCI : p_rdr_a_info->next_seq : %02X\n", p_rdr_a_info->next_seq);
362         }
363     }
364 
365     HCI_PRINT ("HCI : phHciNfc_ReaderA_Info_Sequence end \n");
366     return status;
367 }
368 
369 
370 static
371 NFCSTATUS
phHciNfc_ReaderA_InfoUpdate(phHciNfc_sContext_t * psHciContext,uint8_t index,uint8_t * reg_value,uint8_t reg_length)372 phHciNfc_ReaderA_InfoUpdate(
373                                 phHciNfc_sContext_t     *psHciContext,
374                                 uint8_t                 index,
375                                 uint8_t                 *reg_value,
376                                 uint8_t                 reg_length
377                          )
378 {
379     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
380     phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
381     phHal_sIso14443AInfo_t        *p_tag_a_info = NULL;
382 
383     p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
384                                 (psHciContext->p_reader_a_info );
385     p_tag_a_info = &(p_rdr_a_info->reader_a_info.RemoteDevInfo.Iso14443A_Info);
386 
387     switch(index)
388     {
389         case RDR_A_UID_INDEX:
390         {
391             /* Maximum UID length can go upto 10 bytes */
392             if (reg_length <= PHHAL_MAX_UID_LENGTH)
393             {
394                 HCI_PRINT_BUFFER("\tReader A UID", reg_value, reg_length);
395                 /* Update UID buffer and length */
396                 p_tag_a_info->UidLength = reg_length;
397                 (void)memcpy(
398                         p_tag_a_info->Uid,
399                         reg_value,
400                         p_tag_a_info->UidLength);
401             }
402             else
403             {
404                 status = PHNFCSTVAL(CID_NFC_HCI,
405                     NFCSTATUS_INVALID_HCI_RESPONSE);
406             }
407             break;
408         }
409         case RDR_A_SAK_INDEX:
410         {
411             /* SAK length is 1 byte */
412             if (RDR_A_SAK_FWI_SFGT_LENGTH == reg_length)
413             {
414                 HCI_PRINT_BUFFER("\tReader A SAK", reg_value, reg_length);
415                 /* Copy SAK byte */
416                 p_tag_a_info->Sak = *reg_value;
417             }
418             else
419             {
420                 status = PHNFCSTVAL(CID_NFC_HCI,
421                     NFCSTATUS_INVALID_HCI_RESPONSE);
422             }
423             break;
424         }
425         case RDR_A_ATQA_INDEX:
426         {
427             /* ATQA length shall be 2 bytes */
428             if (PHHAL_ATQA_LENGTH == reg_length)
429             {
430                 HCI_PRINT_BUFFER("\tReader A ATQA", reg_value, reg_length);
431                 /* Copy ATQA */
432                 (void)memcpy(p_tag_a_info->AtqA,
433                     reg_value,
434                     reg_length);
435             }
436             else
437             {
438                 status = PHNFCSTVAL(CID_NFC_HCI,
439                     NFCSTATUS_INVALID_HCI_RESPONSE);
440             }
441             break;
442         }
443         case RDR_A_APP_DATA_INDEX:
444         {
445             /* Remote device info provided by the user */
446             p_tag_a_info =
447                     &(psHciContext->p_target_info->RemoteDevInfo.Iso14443A_Info);
448             /* Historical bytes length shall be 2 bytes */
449             if (reg_length <= RDR_A_MAX_APP_DATA_LEN)
450             {
451                 HCI_PRINT_BUFFER("\tReader A APP DATA", reg_value, reg_length);
452                 p_tag_a_info->AppDataLength = reg_length;
453                 /* Historical bytes */
454                 (void)memcpy(p_tag_a_info->AppData,
455                     reg_value,
456                     reg_length);
457             }
458             else
459             {
460                 status = PHNFCSTVAL(CID_NFC_HCI,
461                     NFCSTATUS_INVALID_HCI_RESPONSE);
462             }
463             break;
464         }
465         case RDR_A_FWI_SFGT_INDEX:
466         {
467             if (RDR_A_SAK_FWI_SFGT_LENGTH == reg_length)
468             {
469                 HCI_PRINT_BUFFER("\tReader A FWI SFGT", reg_value, reg_length);
470                 p_tag_a_info->Fwi_Sfgt = *reg_value;
471             }
472             else
473             {
474                 status = PHNFCSTVAL(CID_NFC_HCI,
475                     NFCSTATUS_INVALID_HCI_RESPONSE);
476             }
477             break;
478         }
479         default:
480         {
481             status = PHNFCSTVAL(CID_NFC_HCI,
482                             NFCSTATUS_INVALID_HCI_RESPONSE);
483             break;
484         }
485     }
486     return status;
487 }
488 
489 
490 static
491 NFCSTATUS
phHciNfc_Recv_ReaderA_Response(void * psContext,void * pHwRef,uint8_t * pResponse,uint8_t length)492 phHciNfc_Recv_ReaderA_Response(
493                         void                *psContext,
494                         void                *pHwRef,
495                         uint8_t             *pResponse,
496 #ifdef ONE_BYTE_LEN
497                         uint8_t             length
498 #else
499                         uint16_t            length
500 #endif
501                        )
502 {
503     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
504     phHciNfc_sContext_t         *psHciContext =
505                                 (phHciNfc_sContext_t *)psContext ;
506 
507 
508     if( (NULL == psHciContext) || (NULL == pHwRef) || (NULL == pResponse)
509         || (length == 0))
510     {
511       status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
512     }
513     else if(NULL == psHciContext->p_reader_a_info)
514     {
515         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
516     }
517     else
518     {
519         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
520         uint8_t                     prev_cmd = ANY_GET_PARAMETER;
521         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
522                             psHciContext->p_reader_a_info ;
523         if( NULL == p_rdr_a_info->p_pipe_info)
524         {
525             status = PHNFCSTVAL(CID_NFC_HCI,
526                             NFCSTATUS_INVALID_HCI_SEQUENCE);
527         }
528         else
529         {
530             prev_cmd = p_rdr_a_info->p_pipe_info->prev_msg ;
531             switch(prev_cmd)
532             {
533                 case ANY_GET_PARAMETER:
534                 {
535                     status = phHciNfc_ReaderA_InfoUpdate(psHciContext,
536                                     p_rdr_a_info->p_pipe_info->reg_index,
537                                     &pResponse[HCP_HEADER_LEN],
538                                     (uint8_t)(length - HCP_HEADER_LEN));
539 #if 0
540                     status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext,
541                                                                 UPDATE_SEQ);
542 #endif
543                     break;
544                 }
545                 case ANY_SET_PARAMETER:
546                 {
547                     HCI_PRINT("Reader A Parameter Set \n");
548                     status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext,
549                                                     UPDATE_SEQ);
550                     p_rdr_a_info->next_seq = RDR_A_UID;
551                     break;
552                 }
553                 case ANY_OPEN_PIPE:
554                 {
555                     HCI_PRINT("Reader A open pipe complete\n");
556                     status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext,
557                                                     UPDATE_SEQ);
558                     p_rdr_a_info->next_seq = RDR_A_UID;
559                     break;
560                 }
561                 case ANY_CLOSE_PIPE:
562                 {
563                     HCI_PRINT("Reader A close pipe complete\n");
564                     status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext,
565                                                     UPDATE_SEQ);
566                     break;
567                 }
568                 case NXP_WRA_CONTINUE_ACTIVATION:
569                 case NXP_WR_ACTIVATE_ID:
570                 {
571                     HCI_PRINT("Reader A continue activation or ");
572                     HCI_PRINT("reactivation completed \n");
573                     status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext,
574                                                     UPDATE_SEQ);
575                     break;
576                 }
577                 case NXP_MIFARE_RAW:
578                 case NXP_MIFARE_CMD:
579                 {
580                     if (length > HCP_HEADER_LEN)
581                     {
582                         HCI_PRINT("Mifare packet received \n");
583                         /* Copy buffer to the receive buffer */
584                         phHciNfc_Append_HCPFrame(psHciContext->recv_buffer,
585                             0, pResponse, length);
586                         psHciContext->rx_total = length;
587                         status = phHciNfc_Recv_Mifare_Packet(psHciContext,
588                                                 prev_cmd,
589                                                 &pResponse[HCP_HEADER_LEN],
590                                                 (length - HCP_HEADER_LEN));
591 
592                     }
593                     else if (length == HCP_HEADER_LEN)
594                     {
595                         psHciContext->rx_total = length;
596                         psHciContext->rx_index = HCP_HEADER_LEN;
597 
598                     }
599                     else
600                     {
601                         status = PHNFCSTVAL(CID_NFC_HCI,
602                                         NFCSTATUS_INVALID_HCI_RESPONSE);
603                     }
604                     break;
605                 }
606                 case WR_XCHGDATA:
607                 {
608                     if (length >= HCP_HEADER_LEN)
609                     {
610                         uint8_t         i = 1;
611                         HCI_PRINT("ISO 14443-4A received \n");
612                         /* Copy buffer to the receive buffer */
613                         phHciNfc_Append_HCPFrame(psHciContext->recv_buffer,
614                             0, pResponse, (length - i));
615                         psHciContext->rx_total = (length - i);
616                         status = phHciNfc_Recv_Iso_A_Packet(psHciContext,
617                                                     &pResponse[HCP_HEADER_LEN],
618                                                     (length - HCP_HEADER_LEN));
619                     }
620                     else
621                     {
622                         status = PHNFCSTVAL(CID_NFC_HCI,
623                                             NFCSTATUS_INVALID_HCI_RESPONSE);
624                     }
625                     break;
626                 }
627                 case NXP_WR_PRESCHECK:
628                 {
629                     HCI_PRINT("Presence check completed \n");
630                     break;
631                 }
632                 case NXP_WR_ACTIVATE_NEXT:
633                 {
634                     if (length > HCP_HEADER_LEN)
635                     {
636                         if (RDR_A_MULTIPLE_TAGS_FOUND == pResponse[HCP_HEADER_LEN])
637                         {
638                             p_rdr_a_info->multiple_tgts_found =
639                                 RDR_A_MULTIPLE_TAGS_FOUND;
640                         }
641                         else
642                         {
643                             p_rdr_a_info->multiple_tgts_found = FALSE;
644                         }
645                         HCI_PRINT("Activate next completed \n");
646                     }
647                     else
648                     {
649                         status = PHNFCSTVAL(CID_NFC_HCI,
650                                         NFCSTATUS_INVALID_HCI_RESPONSE);
651                     }
652                     break;
653                 }
654                 case NXP_WR_DISPATCH_TO_UICC:
655                 {
656                     switch(length)
657                     {
658                         case HCP_HEADER_LEN:
659                         {
660                             /* Optional error code, if no error code field
661                                 in the response, then this command is
662                                 successfully completed */
663                             p_rdr_a_info->uicc_activation =
664                                     UICC_CARD_ACTIVATION_SUCCESS;
665                             break;
666                         }
667                         case (HCP_HEADER_LEN + 1):
668                         {
669                             p_rdr_a_info->uicc_activation =
670                                         pResponse[HCP_HEADER_LEN];
671                             break;
672                         } /* End of case (HCP_HEADER_LEN + index) */
673                         default:
674                         {
675                             status = PHNFCSTVAL(CID_NFC_HCI,
676                                                 NFCSTATUS_INVALID_HCI_RESPONSE);
677                             break;
678                         }
679                     } /* End of switch(length) */
680                     if (NFCSTATUS_SUCCESS == status)
681                     {
682                         status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext,
683                                                                     UPDATE_SEQ);
684                     }
685                     break;
686                 }
687                 default:
688                 {
689                     status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE);
690                     break;
691                 }
692             } /* End of switch(prev_cmd) */
693             if( NFCSTATUS_SUCCESS == status )
694             {
695                 p_rdr_a_info->p_pipe_info->prev_status = NFCSTATUS_SUCCESS;
696                 p_rdr_a_info->current_seq = p_rdr_a_info->next_seq;
697             }
698         }
699     }
700     return status;
701 }
702 
703 static
704 NFCSTATUS
phHciNfc_Recv_Iso_A_Packet(phHciNfc_sContext_t * psHciContext,uint8_t * pResponse,uint8_t length)705 phHciNfc_Recv_Iso_A_Packet(
706                             phHciNfc_sContext_t *psHciContext,
707                             uint8_t             *pResponse,
708 #ifdef ONE_BYTE_LEN
709                             uint8_t             length
710 #else
711                             uint16_t            length
712 #endif
713                             )
714 {
715     NFCSTATUS       status = NFCSTATUS_SUCCESS;
716     uint8_t         i = 1;
717 
718     psHciContext->rx_index = HCP_HEADER_LEN;
719     /* command WRA_XCHG_DATA: so give ISO 14443-4A data to the upper layer */
720     if(FALSE != pResponse[(length - i)])
721     {
722         status = PHNFCSTVAL(CID_NFC_HCI,
723                             NFCSTATUS_RF_ERROR);
724     }
725     HCI_PRINT_BUFFER("ISO 14443- 4A Bytes received", pResponse, length);
726 
727     return status;
728 }
729 
730 static
731 NFCSTATUS
phHciNfc_Recv_Mifare_Packet(phHciNfc_sContext_t * psHciContext,uint8_t cmd,uint8_t * pResponse,uint8_t length)732 phHciNfc_Recv_Mifare_Packet(
733                            phHciNfc_sContext_t  *psHciContext,
734                            uint8_t              cmd,
735                            uint8_t              *pResponse,
736 #ifdef ONE_BYTE_LEN
737                            uint8_t              length
738 #else
739                            uint16_t             length
740 #endif
741                            )
742 {
743     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
744 
745     /* To remove "warning (VS C4100) : unreferenced formal parameter" */
746     PHNFC_UNUSED_VARIABLE(pResponse);
747     PHNFC_UNUSED_VARIABLE(length);
748 
749     if (NXP_MIFARE_RAW == cmd)
750     {
751 #ifdef ENABLE_MIFARE_RAW
752         uint8_t                 index = 0;
753 #ifndef HAL_SW_3A_STATUS
754         if(phHal_eISO14443_3A_PICC == psHciContext->p_target_info->RemDevType)
755         {
756             index++;
757             psHciContext->rx_index = (index + HCP_HEADER_LEN);
758             HCI_PRINT_BUFFER("Mifare Bytes received", &pResponse[index], (length - index));
759         }
760         else
761 #endif
762         if (RDR_A_MIFARE_STATUS == pResponse[index])  /* Status byte */
763         {
764             index++;
765             psHciContext->rx_index = (index + HCP_HEADER_LEN);
766             HCI_PRINT_BUFFER("Mifare Bytes received", &pResponse[index], (length - index));
767         }
768         else
769         {
770             status = PHNFCSTVAL(CID_NFC_HCI,
771                                 NFCSTATUS_INVALID_HCI_RESPONSE);
772         }
773 #else
774         psHciContext->rx_index = HCP_HEADER_LEN;
775         /* Give Mifare data to the upper layer */
776         HCI_PRINT_BUFFER("Mifare Bytes received", pResponse, length);
777 #endif /* #ifdef ENABLE_MIFARE_RAW */
778     }
779     else
780     {
781         psHciContext->rx_index = HCP_HEADER_LEN;
782         /* command NXP_MIFARE_CMD: so give Mifare data to the upper layer */
783         HCI_PRINT_BUFFER("Mifare Bytes received", pResponse, length);
784     }
785 
786     return status;
787 }
788 
789 static
790 NFCSTATUS
phHciNfc_Recv_ReaderA_Event(void * psContext,void * pHwRef,uint8_t * pEvent,uint8_t length)791 phHciNfc_Recv_ReaderA_Event(
792                              void               *psContext,
793                              void               *pHwRef,
794                              uint8_t            *pEvent,
795 #ifdef ONE_BYTE_LEN
796                              uint8_t            length
797 #else
798                              uint16_t           length
799 #endif
800                        )
801 {
802     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
803     phHciNfc_sContext_t         *psHciContext =
804                                 (phHciNfc_sContext_t *)psContext ;
805 
806     HCI_PRINT ("HCI : phHciNfc_Recv_ReaderA_Event called...\n");
807     if( (NULL == psHciContext) || (NULL == pHwRef) || (NULL == pEvent)
808         || (length == 0))
809     {
810         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
811     }
812     else if((NULL == psHciContext->p_reader_a_info) ||
813         (HCI_READER_A_ENABLE !=
814         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
815         enable_rdr_a_gate))
816     {
817         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
818     }
819     else
820     {
821         phHciNfc_HCP_Packet_t       *p_packet = NULL;
822         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
823         phHciNfc_HCP_Message_t      *message = NULL;
824         uint8_t                     instruction=0,
825                                     i = 0;
826 
827         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
828                         psHciContext->p_reader_a_info ;
829         p_packet = (phHciNfc_HCP_Packet_t *)pEvent;
830         message = &p_packet->msg.message;
831         /* Get the instruction bits from the Message Header */
832         instruction = (uint8_t) GET_BITS8( message->msg_header,
833             HCP_MSG_INSTRUCTION_OFFSET, HCP_MSG_INSTRUCTION_LEN);
834 
835         HCI_DEBUG ("HCI : instruction : %02X\n", instruction);
836         HCI_DEBUG ("HCI : Multiple tag found : %02X\n", message->payload[i]);
837 
838         if ((EVT_TARGET_DISCOVERED == instruction)
839             && ((RDR_A_MULTIPLE_TAGS_FOUND == message->payload[i] )
840                 || (RDR_A_SINGLE_TAG_FOUND == message->payload[i]))
841           )
842         {
843             phNfc_sCompletionInfo_t pCompInfo;
844 
845             if (RDR_A_MULTIPLE_TAGS_FOUND == message->payload[i])
846             {
847                 p_rdr_a_info->multiple_tgts_found = RDR_A_MULTIPLE_TAGS_FOUND;
848                 pCompInfo.status = NFCSTATUS_MULTIPLE_TAGS;
849             }
850             else
851             {
852                 p_rdr_a_info->multiple_tgts_found = FALSE;
853                 pCompInfo.status = NFCSTATUS_SUCCESS;
854             }
855 
856             psHciContext->host_rf_type = phHal_eISO14443_A_PCD;
857             p_rdr_a_info->reader_a_info.RemDevType = phHal_eISO14443_A_PICC;
858             p_rdr_a_info->current_seq = RDR_A_UID;
859 
860             HCI_DEBUG ("HCI : psHciContext->host_rf_type : %02X\n", psHciContext->host_rf_type);
861             HCI_DEBUG ("HCI : p_rdr_a_info->reader_a_info.RemDevType : %02X\n", p_rdr_a_info->reader_a_info.RemDevType);
862             HCI_DEBUG ("HCI : p_rdr_a_info->current_seq : %02X\n", p_rdr_a_info->current_seq);
863 
864             /* Notify to the HCI Generic layer To Update the FSM */
865             phHciNfc_Notify_Event(psHciContext, pHwRef,
866                                     NFC_NOTIFY_TARGET_DISCOVERED,
867                                     &pCompInfo);
868 
869         }
870         else
871         {
872             status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE);
873         }
874     }
875     HCI_PRINT ("HCI : phHciNfc_Recv_ReaderA_Event end\n");
876     return status;
877 }
878 
879 NFCSTATUS
phHciNfc_ReaderA_Auto_Activate(void * psContext,void * pHwRef,uint8_t activate_enable)880 phHciNfc_ReaderA_Auto_Activate(
881                                void         *psContext,
882                                void         *pHwRef,
883                                uint8_t      activate_enable
884                                )
885 {
886     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
887     phHciNfc_sContext_t         *psHciContext =
888                                 (phHciNfc_sContext_t *)psContext ;
889     if( (NULL == psHciContext) || (NULL == pHwRef))
890     {
891         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
892     }
893     else if((NULL == psHciContext->p_reader_a_info) ||
894         (HCI_READER_A_ENABLE !=
895         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
896         enable_rdr_a_gate))
897     {
898         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
899     }
900     else
901     {
902         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
903         phHciNfc_Pipe_Info_t        *p_pipe_info=NULL;
904         uint8_t                     pipeid = 0;
905 
906         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
907                                 psHciContext->p_reader_a_info ;
908         p_pipe_info = p_rdr_a_info->p_pipe_info;
909         p_pipe_info->reg_index = NXP_AUTO_ACTIVATION_INDEX;
910         p_pipe_info->param_info = &activate_enable;
911         p_pipe_info->param_length = sizeof(activate_enable);
912         pipeid = p_rdr_a_info->pipe_id ;
913         status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
914                 pipeid, (uint8_t)ANY_SET_PARAMETER);
915         if(NFCSTATUS_PENDING == status )
916         {
917             status = NFCSTATUS_SUCCESS;
918         }
919     }
920     return status;
921 }
922 
923 NFCSTATUS
phHciNfc_ReaderA_Set_DataRateMax(void * psContext,void * pHwRef,uint8_t data_rate_value)924 phHciNfc_ReaderA_Set_DataRateMax(
925                                void         *psContext,
926                                void         *pHwRef,
927                                uint8_t      data_rate_value
928                                )
929 {
930     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
931     phHciNfc_sContext_t         *psHciContext =
932         (phHciNfc_sContext_t *)psContext ;
933     if( (NULL == psHciContext) || (NULL == pHwRef))
934     {
935         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
936     }
937     else if((NULL == psHciContext->p_reader_a_info) ||
938         (HCI_READER_A_ENABLE !=
939         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
940         enable_rdr_a_gate))
941     {
942         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
943     }
944     else
945     {
946         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
947         phHciNfc_Pipe_Info_t        *p_pipe_info=NULL;
948         uint8_t                     pipeid = 0;
949 
950         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
951                             psHciContext->p_reader_a_info ;
952         p_pipe_info = p_rdr_a_info->p_pipe_info;
953         p_pipe_info->reg_index = RDR_A_DATA_RATE_MAX_INDEX;
954         p_pipe_info->param_info = &data_rate_value;
955         p_pipe_info->param_length = sizeof(data_rate_value);
956         pipeid = p_rdr_a_info->pipe_id ;
957         status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
958                                     pipeid, (uint8_t)ANY_SET_PARAMETER);
959     }
960     return status;
961 }
962 
963 
964 NFCSTATUS
phHciNfc_Send_ReaderA_Command(phHciNfc_sContext_t * psHciContext,void * pHwRef,uint8_t pipe_id,uint8_t cmd)965 phHciNfc_Send_ReaderA_Command(
966                               phHciNfc_sContext_t   *psHciContext,
967                               void                  *pHwRef,
968                               uint8_t               pipe_id,
969                               uint8_t               cmd
970                               )
971 {
972     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
973 
974     if( (NULL == psHciContext) || (NULL == pHwRef) )
975     {
976         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
977     }
978     else if((NULL == psHciContext->p_reader_a_info) ||
979         (HCI_READER_A_ENABLE !=
980         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
981         enable_rdr_a_gate) ||
982         (HCI_UNKNOWN_PIPE_ID ==
983         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
984         pipe_id) ||
985         (pipe_id !=
986         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
987         pipe_id))
988     {
989         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
990     }
991     else
992     {
993         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
994         phHciNfc_Pipe_Info_t        *p_pipe_info=NULL;
995         phHciNfc_HCP_Packet_t       *hcp_packet = NULL;
996         phHciNfc_HCP_Message_t      *hcp_message = NULL;
997         uint8_t                     i = 0;
998         uint16_t                    length = HCP_HEADER_LEN;
999 
1000         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
1001                             psHciContext->p_reader_a_info ;
1002         p_pipe_info = p_rdr_a_info->p_pipe_info;
1003         if(NULL == p_pipe_info )
1004         {
1005             status = PHNFCSTVAL(CID_NFC_HCI,
1006                         NFCSTATUS_INVALID_HCI_SEQUENCE);
1007         }
1008         else
1009         {
1010             psHciContext->tx_total = 0 ;
1011             hcp_packet = (phHciNfc_HCP_Packet_t *) psHciContext->send_buffer;
1012             /* Construct the HCP Frame */
1013             switch(cmd)
1014             {
1015                 case NXP_WRA_CONTINUE_ACTIVATION:
1016                 case NXP_WR_ACTIVATE_ID:
1017                 {
1018                     phHciNfc_Build_HCPFrame(hcp_packet,HCP_CHAINBIT_DEFAULT,
1019                         (uint8_t) pipe_id, HCP_MSG_TYPE_COMMAND, cmd);
1020                     break;
1021                 }
1022 
1023                 case NXP_MIFARE_RAW:
1024                 {
1025                     if (p_pipe_info->param_length < RDR_A_MIFARE_RAW_LENGTH)
1026                     {
1027                         status = PHNFCSTVAL(CID_NFC_HCI,
1028                                             NFCSTATUS_INVALID_PARAMETER);
1029                     }
1030                     else
1031                     {
1032                         /*
1033                             Buffer shall be updated with
1034                             TO -              Time out (1 byte)
1035                             Status -          b0 to b2 indicate valid bits (1 byte)
1036                             Data (with CRC) - params received from this function
1037                         */
1038                         hcp_message = &(hcp_packet->msg.message);
1039 #ifdef ENABLE_MIFARE_RAW
1040                         /* Time out */
1041                         hcp_message->payload[i++] = nxp_nfc_mifareraw_timeout;
1042                         /* Status */
1043                         hcp_message->payload[i++] = RDR_A_MIFARE_STATUS;
1044 #else
1045                         cmd = NXP_MIFARE_CMD;
1046 #endif /* #ifdef ENABLE_MIFARE_RAW */
1047                         phHciNfc_Build_HCPFrame(hcp_packet,HCP_CHAINBIT_DEFAULT,
1048                             (uint8_t) pipe_id, HCP_MSG_TYPE_COMMAND, cmd);
1049 
1050                         phHciNfc_Append_HCPFrame((uint8_t *)hcp_message->payload,
1051                             i, (uint8_t *)p_pipe_info->param_info,
1052 #ifdef ENABLE_MIFARE_RAW
1053                             p_pipe_info->param_length);
1054 #else
1055                             (p_pipe_info->param_length - 2));
1056 #endif /* #ifdef ENABLE_MIFARE_RAW */
1057 
1058 #ifdef ENABLE_MIFARE_RAW
1059                         length =(uint16_t)(length + i + p_pipe_info->param_length);
1060 #else
1061                         length =(uint16_t)(length + i + p_pipe_info->param_length - 2);
1062 #endif /* #ifdef ENABLE_MIFARE_RAW */
1063                     }
1064                     break;
1065                 }
1066                 case NXP_MIFARE_CMD:
1067                 {
1068                     /*
1069                         Buffer shall be updated with
1070                         Cmd -               Authentication A/B, read/write
1071                                             (1 byte)
1072                         Addr -              Address associated with Mifare cmd
1073                                             (1 byte)
1074                         Data  -             params received from this function
1075                     */
1076                     phHciNfc_Build_HCPFrame(hcp_packet,HCP_CHAINBIT_DEFAULT,
1077                                 (uint8_t) pipe_id, HCP_MSG_TYPE_COMMAND, cmd);
1078                     hcp_message = &(hcp_packet->msg.message);
1079 
1080                     /* Command */
1081                     hcp_message->payload[i++] =
1082                                    psHciContext->p_xchg_info->params.tag_info.cmd_type ;
1083                      /* Address */
1084                     hcp_message->payload[i++] =
1085                                     psHciContext->p_xchg_info->params.tag_info.addr ;
1086                     phHciNfc_Append_HCPFrame((uint8_t *)hcp_message->payload,
1087                         i, (uint8_t *)p_pipe_info->param_info,
1088                         p_pipe_info->param_length);
1089                     length =(uint16_t)(length + i + p_pipe_info->param_length);
1090                     break;
1091                 }
1092                 default:
1093                 {
1094                     status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_COMMAND);
1095                     break;
1096                 }
1097             }
1098             if (NFCSTATUS_SUCCESS == status)
1099             {
1100                 p_pipe_info->sent_msg_type = (uint8_t)HCP_MSG_TYPE_COMMAND;
1101                 p_pipe_info->prev_msg = cmd;
1102                 psHciContext->tx_total = length;
1103                 psHciContext->response_pending = TRUE;
1104 
1105                 /* Send the Constructed HCP packet to the lower layer */
1106                 status = phHciNfc_Send_HCP( psHciContext, pHwRef);
1107                 p_pipe_info->prev_status = status;
1108             }
1109         }
1110     }
1111     return status;
1112 }
1113 
1114 NFCSTATUS
phHciNfc_ReaderA_Cont_Activate(phHciNfc_sContext_t * psHciContext,void * pHwRef)1115 phHciNfc_ReaderA_Cont_Activate (
1116                               phHciNfc_sContext_t       *psHciContext,
1117                               void                      *pHwRef
1118                               )
1119 {
1120     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
1121 
1122     if( (NULL == psHciContext) || (NULL == pHwRef) )
1123     {
1124         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
1125     }
1126     else if((NULL == psHciContext->p_reader_a_info) ||
1127         (HCI_READER_A_ENABLE !=
1128         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
1129         enable_rdr_a_gate))
1130     {
1131         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
1132     }
1133     else
1134     {
1135         phHciNfc_ReaderA_Info_t     *p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
1136                                     psHciContext->p_reader_a_info;
1137         /*
1138             NXP_WRA_CONTINUE_ACTIVATION:
1139             for activation command */
1140         status = phHciNfc_Send_ReaderA_Command(psHciContext,
1141                         pHwRef, (uint8_t)p_rdr_a_info->pipe_id,
1142                         (uint8_t)NXP_WRA_CONTINUE_ACTIVATION);
1143     }
1144     return status;
1145 }
1146 
1147 NFCSTATUS
phHciNfc_ReaderA_Update_Info(phHciNfc_sContext_t * psHciContext,uint8_t infotype,void * rdr_a_info)1148 phHciNfc_ReaderA_Update_Info(
1149                              phHciNfc_sContext_t        *psHciContext,
1150                              uint8_t                    infotype,
1151                              void                       *rdr_a_info
1152                              )
1153 {
1154     NFCSTATUS                   status = NFCSTATUS_SUCCESS;
1155 
1156     if (NULL == psHciContext)
1157     {
1158         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
1159     }
1160     else if(NULL == psHciContext->p_reader_a_info)
1161     {
1162         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
1163     }
1164     else
1165     {
1166         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
1167         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
1168                         psHciContext->p_reader_a_info ;
1169 
1170         switch(infotype)
1171         {
1172             case HCI_READER_A_ENABLE:
1173             {
1174                 if(NULL != rdr_a_info)
1175                 {
1176                     p_rdr_a_info->enable_rdr_a_gate =
1177                                     *((uint8_t *)rdr_a_info);
1178                 }
1179                 break;
1180             }
1181             case HCI_READER_A_INFO_SEQ:
1182             {
1183                 p_rdr_a_info->current_seq = RDR_A_UID;
1184                 p_rdr_a_info->next_seq = RDR_A_UID;
1185                 break;
1186             }
1187             default:
1188             {
1189                 status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
1190                 break;
1191             }
1192         }
1193     }
1194     return status;
1195 }
1196 
1197 NFCSTATUS
phHciNfc_ReaderA_App_Data(void * psHciHandle,void * pHwRef)1198 phHciNfc_ReaderA_App_Data (
1199                                 void             *psHciHandle,
1200                                 void             *pHwRef
1201                                 )
1202 {
1203     NFCSTATUS               status = NFCSTATUS_SUCCESS;
1204     phHciNfc_sContext_t     *psHciContext = ((phHciNfc_sContext_t *)psHciHandle);
1205     if( (NULL == psHciContext)
1206         || (NULL == pHwRef)
1207         )
1208     {
1209         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
1210     }
1211     else if((NULL == psHciContext->p_reader_a_info) ||
1212         (HCI_READER_A_ENABLE !=
1213         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
1214         enable_rdr_a_gate))
1215     {
1216         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
1217     }
1218     else
1219     {
1220         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
1221         phHciNfc_Pipe_Info_t        *p_pipe_info=NULL;
1222         uint8_t                     pipeid = 0;
1223 
1224         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
1225             psHciContext->p_reader_a_info ;
1226         p_pipe_info = p_rdr_a_info->p_pipe_info;
1227         if(NULL == p_pipe_info )
1228         {
1229             status = PHNFCSTVAL(CID_NFC_HCI,
1230                 NFCSTATUS_INVALID_HCI_SEQUENCE);
1231         }
1232         else
1233         {
1234             p_pipe_info->reg_index = RDR_A_APP_DATA_INDEX;
1235             pipeid = p_rdr_a_info->pipe_id ;
1236             /* Fill the data buffer and send the command to the
1237             device */
1238             status =
1239                 phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
1240                 pipeid, (uint8_t)ANY_GET_PARAMETER);
1241         }
1242     }
1243     return status;
1244 }
1245 
1246 NFCSTATUS
phHciNfc_ReaderA_Fwi_Sfgt(void * psHciHandle,void * pHwRef)1247 phHciNfc_ReaderA_Fwi_Sfgt (
1248                            void             *psHciHandle,
1249                            void             *pHwRef
1250                            )
1251 {
1252     NFCSTATUS               status = NFCSTATUS_SUCCESS;
1253     phHciNfc_sContext_t     *psHciContext = ((phHciNfc_sContext_t *)psHciHandle);
1254     if( (NULL == psHciContext)
1255         || (NULL == pHwRef)
1256         )
1257     {
1258         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER);
1259     }
1260     else if((NULL == psHciContext->p_reader_a_info) ||
1261         (HCI_READER_A_ENABLE !=
1262         ((phHciNfc_ReaderA_Info_t *)(psHciContext->p_reader_a_info))->
1263         enable_rdr_a_gate))
1264     {
1265         status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED);
1266     }
1267     else
1268     {
1269         phHciNfc_ReaderA_Info_t     *p_rdr_a_info=NULL;
1270         phHciNfc_Pipe_Info_t        *p_pipe_info=NULL;
1271         uint8_t                     pipeid = 0;
1272 
1273         p_rdr_a_info = (phHciNfc_ReaderA_Info_t *)
1274             psHciContext->p_reader_a_info ;
1275         p_pipe_info = p_rdr_a_info->p_pipe_info;
1276         if(NULL == p_pipe_info )
1277         {
1278             status = PHNFCSTVAL(CID_NFC_HCI,
1279                 NFCSTATUS_INVALID_HCI_SEQUENCE);
1280         }
1281         else
1282         {
1283             p_pipe_info->reg_index = RDR_A_FWI_SFGT_INDEX;
1284             pipeid = p_rdr_a_info->pipe_id ;
1285             /* Fill the data buffer and send the command to the
1286             device */
1287             status =
1288                 phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef,
1289                 pipeid, (uint8_t)ANY_GET_PARAMETER);
1290         }
1291     }
1292     return status;
1293 }
1294 
1295