Gitiles
Code Review Sign In
review.blissroms.org / platform_external_libnfc-nxp / refs/heads/o8.0-rebase / . / src / phHciNfc_RFReaderA.c
blob: 1b1280a58c3d4b61e30ca16b1d53cb7bbe3fc483 [file] [log] [blame]
Nick Pelly5d9927b2010-09-23 12:47:58 -0700[diff] [blame]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
Martijn Coenen01a91ea2011-06-09 15:55:19 +0200[diff] [blame]70uint8_t nxp_nfc_mifareraw_timeout = NXP_MIFARE_XCHG_TIMEOUT;
Nick Pelly5d9927b2010-09-23 12:47:58 -0700[diff] [blame]71/*
72*************************** Structure and Enumeration ***************************
73*/
74
75
76/*
77*************************** Static Function Declaration **************************
78*/
79
80static
81NFCSTATUS
82phHciNfc_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
93static
94NFCSTATUS
95phHciNfc_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
106static
107NFCSTATUS
108phHciNfc_ReaderA_InfoUpdate(
109 phHciNfc_sContext_t *psHciContext,
110 uint8_t index,
111 uint8_t *reg_value,
112 uint8_t reg_length
113 );
114
115static
116NFCSTATUS
117phHciNfc_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
128static
129NFCSTATUS
130phHciNfc_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*/
142NFCSTATUS
143phHciNfc_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
168NFCSTATUS
169phHciNfc_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
201NFCSTATUS
202phHciNfc_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
238NFCSTATUS
239phHciNfc_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
370static
371NFCSTATUS
372phHciNfc_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
490static
491NFCSTATUS
492phHciNfc_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
703static
704NFCSTATUS
705phHciNfc_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
730static
731NFCSTATUS
732phHciNfc_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
789static
790NFCSTATUS
791phHciNfc_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
879NFCSTATUS
880phHciNfc_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
923NFCSTATUS
924phHciNfc_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
964NFCSTATUS
965phHciNfc_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 */
Martijn Coenen01a91ea2011-06-09 15:55:19 +0200[diff] [blame]1041 hcp_message->payload[i++] = nxp_nfc_mifareraw_timeout;
Nick Pelly5d9927b2010-09-23 12:47:58 -0700[diff] [blame]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
1114NFCSTATUS
1115phHciNfc_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
1147NFCSTATUS
1148phHciNfc_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
1197NFCSTATUS
1198phHciNfc_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
1246NFCSTATUS
1247phHciNfc_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