/* * Copyright (C) 2021 The Android Open Source Project * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #include #include #include #include #include #include #include #include "Cf_hal_api.h" #include "hardware_nfc.h" using android::base::StringPrintf; bool hal_opened = false; bool dbg_logging = false; pthread_mutex_t hmutex = PTHREAD_MUTEX_INITIALIZER; nfc_stack_callback_t* e_cback; nfc_stack_data_callback_t* d_cback; static struct aidl_callback_struct { pthread_mutex_t mutex; pthread_cond_t cond; pthread_t thr; int event_pending; int stop_thread; int thread_running; nfc_event_t event; nfc_status_t event_status; } aidl_callback_data; static void* aidl_callback_thread_fct(void* arg) { int ret; struct aidl_callback_struct* pcb_data = (struct aidl_callback_struct*)arg; ret = pthread_mutex_lock(&pcb_data->mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_lock failed", __func__); goto error; } do { if (pcb_data->event_pending == 0) { ret = pthread_cond_wait(&pcb_data->cond, &pcb_data->mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_wait failed", __func__); break; } } if (pcb_data->event_pending) { nfc_event_t event = pcb_data->event; nfc_status_t event_status = pcb_data->event_status; int ending = pcb_data->stop_thread; pcb_data->event_pending = 0; ret = pthread_cond_signal(&pcb_data->cond); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_signal failed", __func__); break; } if (ending) { pcb_data->thread_running = 0; } ret = pthread_mutex_unlock(&pcb_data->mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_unlock failed", __func__); } LOG(INFO) << StringPrintf("%s event %hhx status %hhx", __func__, event, event_status); e_cback(event, event_status); usleep(50000); if (ending) { return NULL; } ret = pthread_mutex_lock(&pcb_data->mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_lock failed", __func__); goto error; } } } while (pcb_data->stop_thread == 0 || pcb_data->event_pending); ret = pthread_mutex_unlock(&pcb_data->mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_unlock failed", __func__); } error: pcb_data->thread_running = 0; return NULL; } static int aidl_callback_thread_start() { int ret; LOG(INFO) << StringPrintf("%s", __func__); memset(&aidl_callback_data, 0, sizeof(aidl_callback_data)); ret = pthread_mutex_init(&aidl_callback_data.mutex, NULL); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_init failed", __func__); return ret; } ret = pthread_cond_init(&aidl_callback_data.cond, NULL); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_init failed", __func__); return ret; } aidl_callback_data.thread_running = 1; ret = pthread_create(&aidl_callback_data.thr, NULL, aidl_callback_thread_fct, &aidl_callback_data); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_create failed", __func__); aidl_callback_data.thread_running = 0; return ret; } return 0; } static int aidl_callback_thread_end() { LOG(INFO) << StringPrintf("%s", __func__); if (aidl_callback_data.thread_running != 0) { int ret; ret = pthread_mutex_lock(&aidl_callback_data.mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_lock failed", __func__); return ret; } aidl_callback_data.stop_thread = 1; // Wait for the thread to have no event pending while (aidl_callback_data.thread_running && aidl_callback_data.event_pending) { ret = pthread_cond_signal(&aidl_callback_data.cond); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_signal failed", __func__); return ret; } ret = pthread_cond_wait(&aidl_callback_data.cond, &aidl_callback_data.mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_wait failed", __func__); break; } } ret = pthread_mutex_unlock(&aidl_callback_data.mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_unlock failed", __func__); return ret; } ret = pthread_cond_signal(&aidl_callback_data.cond); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_signal failed", __func__); return ret; } ret = pthread_detach(aidl_callback_data.thr); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_detach failed", __func__); return ret; } } return 0; } static void aidl_callback_post(nfc_event_t event, nfc_status_t event_status) { int ret; if (pthread_equal(pthread_self(), aidl_callback_data.thr)) { e_cback(event, event_status); } ret = pthread_mutex_lock(&aidl_callback_data.mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_lock failed", __func__); return; } if (aidl_callback_data.thread_running == 0) { (void)pthread_mutex_unlock(&aidl_callback_data.mutex); LOG(ERROR) << StringPrintf("%s thread is not running", __func__); e_cback(event, event_status); return; } while (aidl_callback_data.event_pending) { ret = pthread_cond_wait(&aidl_callback_data.cond, &aidl_callback_data.mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_wait failed", __func__); return; } } aidl_callback_data.event_pending = 1; aidl_callback_data.event = event; aidl_callback_data.event_status = event_status; ret = pthread_mutex_unlock(&aidl_callback_data.mutex); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_mutex_unlock failed", __func__); return; } ret = pthread_cond_signal(&aidl_callback_data.cond); if (ret != 0) { LOG(ERROR) << StringPrintf("%s pthread_cond_signal failed", __func__); return; } } int Cf_hal_open(nfc_stack_callback_t* p_cback, nfc_stack_data_callback_t* p_data_cback) { LOG(INFO) << StringPrintf("%s", __func__); pthread_mutex_lock(&hmutex); if (hal_opened) { // already opened, close then open again LOG(INFO) << StringPrintf("%s close and open again", __func__); if (aidl_callback_data.thread_running && aidl_callback_thread_end() != 0) { pthread_mutex_unlock(&hmutex); return -1; } hal_opened = false; } e_cback = p_cback; d_cback = p_data_cback; if ((hal_opened || !aidl_callback_data.thread_running) && (aidl_callback_thread_start() != 0)) { // status failed LOG(INFO) << StringPrintf("%s failed", __func__); aidl_callback_post(HAL_NFC_OPEN_CPLT_EVT, HAL_NFC_STATUS_FAILED); pthread_mutex_unlock(&hmutex); return -1; } hal_opened = true; aidl_callback_post(HAL_NFC_OPEN_CPLT_EVT, HAL_NFC_STATUS_OK); pthread_mutex_unlock(&hmutex); return 0; } int Cf_hal_write(uint16_t data_len, const uint8_t* p_data) { if (!hal_opened) return -1; // TODO: write NCI state machine (void)data_len; (void)p_data; return 0; } int Cf_hal_core_initialized() { if (!hal_opened) return -1; pthread_mutex_lock(&hmutex); aidl_callback_post(HAL_NFC_POST_INIT_CPLT_EVT, HAL_NFC_STATUS_OK); pthread_mutex_unlock(&hmutex); return 0; } int Cf_hal_pre_discover() { if (!hal_opened) return -1; pthread_mutex_lock(&hmutex); aidl_callback_post(HAL_NFC_PRE_DISCOVER_CPLT_EVT, HAL_NFC_STATUS_OK); pthread_mutex_unlock(&hmutex); return 0; } int Cf_hal_close() { LOG(INFO) << StringPrintf("%s", __func__); if (!hal_opened) return -1; pthread_mutex_lock(&hmutex); hal_opened = false; aidl_callback_post(HAL_NFC_CLOSE_CPLT_EVT, HAL_NFC_STATUS_OK); if (aidl_callback_data.thread_running && aidl_callback_thread_end() != 0) { LOG(ERROR) << StringPrintf("%s thread end failed", __func__); pthread_mutex_unlock(&hmutex); return -1; } pthread_mutex_unlock(&hmutex); return 0; } int Cf_hal_close_off() { LOG(INFO) << StringPrintf("%s", __func__); if (!hal_opened) return -1; pthread_mutex_lock(&hmutex); hal_opened = false; aidl_callback_post(HAL_NFC_CLOSE_CPLT_EVT, HAL_NFC_STATUS_OK); if (aidl_callback_data.thread_running && aidl_callback_thread_end() != 0) { LOG(ERROR) << StringPrintf("%s thread end failed", __func__); pthread_mutex_unlock(&hmutex); return -1; } pthread_mutex_unlock(&hmutex); return 0; } int Cf_hal_power_cycle() { if (!hal_opened) return -1; pthread_mutex_lock(&hmutex); aidl_callback_post(HAL_NFC_OPEN_CPLT_EVT, HAL_NFC_STATUS_OK); pthread_mutex_unlock(&hmutex); return 0; } void Cf_hal_factoryReset() {} void Cf_hal_getConfig(NfcConfig& config) { // TODO: read config from /vendor/etc/libnfc-hal-cf.conf memset(&config, 0x00, sizeof(NfcConfig)); config.nfaPollBailOutMode = 1; config.maxIsoDepTransceiveLength = 0xFEFF; config.defaultOffHostRoute = 0x81; config.defaultOffHostRouteFelica = 0x81; config.defaultSystemCodeRoute = 0x00; config.defaultSystemCodePowerState = 0x3B; config.defaultRoute = 0x00; config.offHostRouteUicc.resize(1); config.offHostRouteUicc[0] = 0x81; config.offHostRouteEse.resize(1); config.offHostRouteEse[0] = 0x81; config.defaultIsoDepRoute = 0x81; } void Cf_hal_setVerboseLogging(bool enable) { dbg_logging = enable; } bool Cf_hal_getVerboseLogging() { return dbg_logging; }