phOsalNfc.c revision 5ea62ad25e2050f543d8e2104f5ffc1bb2c1ef28 
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 * \file phOsalNfc.c
19 * \brief OSAL Implementation for linux
20 *
21 * Project: Trusted NFC Linux Light
22 *
23 * $Date: 03 aug 2009
24 * $Author: Jérémie Corbier
25 * $Revision: 1.0
26 *
27 */
28
29#include <stddef.h>
30#include <stdlib.h>
31#include <stdio.h>
32#include <signal.h>
33#include <unistd.h>
34
35#include <phOsalNfc.h>
36
37#ifdef ANDROID
38#define LOG_TAG "NFC-HCI"
39
40#include <utils/Log.h>
41
42phOsalNfc_Exception_t phOsalNfc_Exception;
43#endif
44
45#ifdef DEBUG
46#define MAX_PRINT_BUFSIZE (0x450U)
47char phOsalNfc_DbgTraceBuffer[MAX_PRINT_BUFSIZE];
48#endif
49
50/*!
51 * \brief Allocates memory.
52 *        This function attempts to allocate \a size bytes on the heap and
53 *        returns a pointer to the allocated block.
54 *
55 * \param size size of the memory block to be allocated on the heap.
56 *
57 * \return pointer to allocated memory block or NULL in case of error.
58 */
59void *phOsalNfc_GetMemory(uint32_t size)
60{
61   void *pMem = (void *)malloc(size);
62   return pMem;
63}
64
65/*!
66 * \brief Frees allocated memory block.
67 *        This function deallocates memory region pointed to by \a pMem.
68 *
69 * \param pMem pointer to memory block to be freed.
70 */
71void phOsalNfc_FreeMemory(void *pMem)
72{
73   if(NULL !=  pMem)
74      free(pMem);
75}
76
77void phOsalNfc_DbgString(const char *pString)
78{
79#ifdef DEBUG
80   if(pString != NULL)
81#ifndef ANDROID
82      printf(pString);
83#else
84      LOGD("%s", pString);
85#endif
86#endif
87}
88
89void phOsalNfc_DbgTrace(uint8_t data[], uint32_t size)
90{
91#ifdef DEBUG
92   uint32_t i;
93#ifdef ANDROID
94   char buf[10];
95#endif
96
97   if(size == 0)
98      return;
99
100#ifndef ANDROID
101   for(i = 0; i < size; i++)
102   {
103      if((i % 10) == 0)
104         printf("\n\t\t\t");
105      printf("%02X ", data[i]);
106   }
107   printf("\n\tBlock size is: %d\n", size);
108#else
109   phOsalNfc_DbgTraceBuffer[0] = '\0';
110   for(i = 0; i < size; i++)
111   {
112      if((i % 10) == 0)
113      {
114         LOGD("%s", phOsalNfc_DbgTraceBuffer);
115         phOsalNfc_DbgTraceBuffer[0] = '\0';
116      }
117
118      snprintf(buf, 10, "%02X ", data[i]);
119      strncat(phOsalNfc_DbgTraceBuffer, buf, 10);
120   }
121   LOGD("%s", phOsalNfc_DbgTraceBuffer);
122   LOGD("Block size is: %d", size);
123#endif
124#endif
125}
126
127/*!
128 * \brief Raises exception.
129 *        This function raises an exception of type \a eExceptionType with
130 *        reason \a reason to stack clients.
131 *
132 * \param eExceptionType exception type.
133 * \param reason reason for this exception.
134 *
135 * \note Clients willing to catch exceptions are to handle the SIGABRT signal.
136 *       On Linux, exception type and reason are passed to the signal handler as
137 *       a pointer to a phOsalNfc_Exception_t structure.
138 *       As sigqueue is not available in Android, exception information are
139 *       stored in the phOsalNfc_Exception global.
140 */
141void phOsalNfc_RaiseException(phOsalNfc_ExceptionType_t eExceptionType, uint16_t reason)
142{
143    LOGD("phOsalNfc_RaiseException() called");
144
145    if(eExceptionType == phOsalNfc_e_UnrecovFirmwareErr)
146    {
147        LOGE("HCI Timeout - Exception raised");
148        LOGE("Force restart of NFC Service");
149        abort();
150    }
151}
152
153/*!
154 * \brief display data bytes.
155 *        This function displays data bytes for debug purpose
156 * \param[in] pString pointer to string to be displayed.
157 * \param[in] length number of bytes to be displayed.
158 * \param[in] pBuffer pointer to data bytes to be displayed.
159 *
160 */
161void phOsalNfc_PrintData(const char *pString, uint32_t length, uint8_t *pBuffer,
162        int verbosity)
163{
164    char print_buffer[length * 3 + 1];
165    unsigned int i;
166
167    if (pString == NULL) {
168        pString = "";
169    }
170    print_buffer[0] = '\0';
171    for (i = 0; i < length; i++) {
172        snprintf(&print_buffer[i*3], 4, " %02X", pBuffer[i]);
173    }
174
175    char llc[40] = "";
176
177    if (verbosity >= 2) {
178        uint8_t llc_header = 0;
179        if (!strcmp(pString, "SEND") && length >= 2) {
180            llc_header = pBuffer[1];
181        } else if (!strcmp(pString, "RECV") && length >= 2) {
182            llc_header = pBuffer[0];
183        }
184
185        if ((llc_header & 0xC0) == 0x80) {
186            // I
187            uint8_t ns = (llc_header & 0x38) >> 3;
188            uint8_t nr = llc_header & 0x07;
189            snprintf(&llc[0], sizeof(llc), "I %d (%d)", ns, nr);
190        } else if ((llc_header & 0xE0) == 0xC0) {
191            // S
192            uint8_t t = (llc_header & 0x18) >> 3;
193            uint8_t nr = llc_header & 0x07;
194            char *type;
195            switch (t) {
196            case 0x00: type = "RR "; break;
197            case 0x01: type = "REJ"; break;
198            case 0x02: type = "RNR"; break;
199            case 0x03: type = "SREJ"; break;
200            default: type = "???"; break;
201            }
202            snprintf(&llc[0], sizeof(llc), "S %s (%d)", type, nr);
203        } else if ((llc_header & 0xE0) == 0xE0) {
204            // U
205            snprintf(&llc[0], sizeof(llc), "U");
206        } else if (length > 1) {
207            snprintf(&llc[0], sizeof(llc), "???");
208        }
209    }
210
211    LOGD("> %s:%s\t%s", pString, print_buffer, llc);
212}
213