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