1fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal/* 2fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * Copyright (C) 2015 The Android Open Source Project 3fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * 4fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * Licensed under the Apache License, Version 2.0 (the "License"); 5fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * you may not use this file except in compliance with the License. 6fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * You may obtain a copy of the License at 7fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * 8fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * http://www.apache.org/licenses/LICENSE-2.0 9fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * 10fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * Unless required by applicable law or agreed to in writing, software 11fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * distributed under the License is distributed on an "AS IS" BASIS, 12fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * See the License for the specific language governing permissions and 14fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * limitations under the License. 15fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal */ 16fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 17fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#define LOG_TAG "vehicle_hw_default" 18fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#define LOG_NDEBUG 1 19fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#define RADIO_PRESET_NUM 6 20fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 2108c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park#define UNUSED __attribute__((__unused__)) 2208c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park 23fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <errno.h> 2408c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park#include <inttypes.h> 25fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <malloc.h> 26fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <pthread.h> 27fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <stdint.h> 28fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <stdlib.h> 29fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <string.h> 30fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <sys/prctl.h> 31fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <sys/time.h> 32fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <time.h> 33fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 34fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <cutils/log.h> 35fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <system/radio.h> 36fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <hardware/hardware.h> 37fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal#include <hardware/vehicle.h> 38fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 39fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalextern int64_t elapsedRealtimeNano(); 40fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 41fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic char VEHICLE_MAKE[] = "android_car"; 42fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 43fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwaltypedef struct vehicle_device_impl { 44fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_hw_device_t vehicle_device; 45fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal uint32_t initialized_; 46fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_event_callback_fn event_fn_; 47fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_error_callback_fn error_fn_; 48fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} vehicle_device_impl_t ; 49fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 50fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic pthread_mutex_t lock_; 51fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 52fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwaltypedef struct subscription { 53fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Each subscription has it's own thread. 54fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_t thread_id; 55fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int32_t prop; 56fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal float sample_rate; 57fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_t lock; 58fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // This field should be protected by the above mutex. 59fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // TODO change this to something better as flag alone takes long time to finish. 60fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal uint32_t stop_thread; 61fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* impl; 62fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_t thread; 63fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_cond_t cond; 64fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal char name[100]; 65fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} subscription_t; 66fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 67fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic vehicle_prop_config_t CONFIGS[] = { 68fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal { 69fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .prop = VEHICLE_PROPERTY_INFO_MAKE, 70fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .access = VEHICLE_PROP_ACCESS_READ, 71fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .change_mode = VEHICLE_PROP_CHANGE_MODE_STATIC, 72fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .value_type = VEHICLE_VALUE_TYPE_STRING, 73fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .min_sample_rate = 0, 74fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .max_sample_rate = 0, 75fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_data = NULL, 76fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 77fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal { 78fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .prop = VEHICLE_PROPERTY_GEAR_SELECTION, 79fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .access = VEHICLE_PROP_ACCESS_READ, 80fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .change_mode = VEHICLE_PROP_CHANGE_MODE_ON_CHANGE, 81fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .value_type = VEHICLE_VALUE_TYPE_INT32, 82fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .min_sample_rate = 0, 83fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .max_sample_rate = 0, 84fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_data = NULL, 85fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 86fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal { 87fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .prop = VEHICLE_PROPERTY_DRIVING_STATUS, 88fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .access = VEHICLE_PROP_ACCESS_READ, 89fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .change_mode = VEHICLE_PROP_CHANGE_MODE_ON_CHANGE, 90fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .value_type = VEHICLE_VALUE_TYPE_INT32, 91fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .min_sample_rate = 0, 92fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .max_sample_rate = 0, 93fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_data = NULL, 94fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 95fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal { 96fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .prop = VEHICLE_PROPERTY_PARKING_BRAKE_ON, 97fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .access = VEHICLE_PROP_ACCESS_READ, 98fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .change_mode = VEHICLE_PROP_CHANGE_MODE_ON_CHANGE, 99fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .value_type = VEHICLE_VALUE_TYPE_BOOLEAN, 100fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .min_sample_rate = 0, 101fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .max_sample_rate = 0, 102fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_data = NULL, 103fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 104fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal { 105fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .prop = VEHICLE_PROPERTY_PERF_VEHICLE_SPEED, 106fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .access = VEHICLE_PROP_ACCESS_READ, 107fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .change_mode = VEHICLE_PROP_CHANGE_MODE_CONTINUOUS, 108fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .value_type = VEHICLE_VALUE_TYPE_FLOAT, 109fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .min_sample_rate = 0.1, 110fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .max_sample_rate = 10.0, 111fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_data = NULL, 112fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 113fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal { 114fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .prop = VEHICLE_PROPERTY_RADIO_PRESET, 115fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .access = VEHICLE_PROP_ACCESS_READ_WRITE, 116fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .change_mode = VEHICLE_PROP_CHANGE_MODE_ON_CHANGE, 117fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .value_type = VEHICLE_VALUE_TYPE_INT32_VEC4, 118fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .vehicle_radio_num_presets = RADIO_PRESET_NUM, 119fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .min_sample_rate = 0, 120fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .max_sample_rate = 0, 121fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_data = NULL, 122fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 123fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal}; 124fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 125fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalvehicle_prop_config_t* find_config(int prop) { 12608c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park unsigned int i; 127fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal for (i = 0; i < sizeof(CONFIGS) / sizeof(vehicle_prop_config_t); i++) { 128fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (CONFIGS[i].prop == prop) { 129fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return &CONFIGS[i]; 130fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 131fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 132fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return NULL; 133fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 134fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 135fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic int alloc_vehicle_str_from_cstr(const char* string, vehicle_str_t* vehicle_str) { 136fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int len = strlen(string); 137fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_str->data = (uint8_t*) malloc(len); 138fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (vehicle_str->data == NULL) { 139fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -ENOMEM; 140fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 141fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal memcpy(vehicle_str->data, string, len); 142fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_str->len = len; 143fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 144fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 145fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 14608c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Parkstatic vehicle_prop_config_t const * vdev_list_properties(vehicle_hw_device_t* device UNUSED, 147fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int* num_properties) { 148fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_list_properties."); 149fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 150fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal *num_properties = sizeof(CONFIGS) / sizeof(vehicle_prop_config_t); 151fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return CONFIGS; 152fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 153fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 154fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic int vdev_init(vehicle_hw_device_t* device, 155fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_event_callback_fn event_callback_fn, 156fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_error_callback_fn error_callback_fn) { 157fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_init."); 158fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* impl = (vehicle_device_impl_t*)device; 159fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&lock_); 160fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (impl->initialized_) { 161fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_init: Callback and Error functions are already existing."); 162fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 163fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EEXIST; 164fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 165fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 166fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal impl->initialized_ = 1; 167fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal impl->event_fn_ = event_callback_fn; 168fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal impl->error_fn_ = error_callback_fn; 169fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 170fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 171fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 172fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 173fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic int vdev_release(vehicle_hw_device_t* device) { 174fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* impl = (vehicle_device_impl_t*)device; 175fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&lock_); 176fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (!impl->initialized_) { 177fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_release: Already released before, returning early."); 178fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else { 179fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // unsubscribe_all() 180fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal impl->initialized_ = 0; 181fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 182fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 183fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 184fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 185fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 18608c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Parkstatic int vdev_get(vehicle_hw_device_t* device UNUSED, vehicle_prop_value_t* data) { 187fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_get."); 188fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal //TODO all data supporting read should support get 189fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (!data) { 190fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_get: Data cannot be null."); 191fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 192fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 193fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_prop_config_t* config = find_config(data->prop); 194fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (config == NULL) { 195fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_get: cannot find config 0x%x", data->prop); 196fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 197fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 198fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value_type = config->value_type; 199fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // for STATIC type, time can be just 0 instead 200fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->timestamp = elapsedRealtimeNano(); 201fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int r; 202fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal switch (data->prop) { 203fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_INFO_MAKE: 204fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal r = alloc_vehicle_str_from_cstr(VEHICLE_MAKE, &(data->value.str_value)); 205fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (r != 0) { 206fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_get: alloc failed"); 207fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return r; 208fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 209fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 210fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 211fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_RADIO_PRESET: { 212fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int radio_preset = data->value.int32_array[0]; 213fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (radio_preset < VEHICLE_RADIO_PRESET_MIN_VALUE || 214fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal radio_preset >= RADIO_PRESET_NUM) { 215fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("%s Invalid radio preset: %d\n", __func__, radio_preset); 216fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -1; 217fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 218fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("%s Radio Preset number: %d", __func__, radio_preset); 219fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int32_t selector = radio_preset % 2 == 0; 220fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Populate the channel and subchannel to be some variation of the 221fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // preset number for mocking. 222fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 223fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Restore the preset number. 224fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value.int32_array[0] = radio_preset; 225fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Channel type values taken from 226fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // system/core/include/system/radio.h 227fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value.int32_array[1] = selector ? RADIO_BAND_FM : RADIO_BAND_AM; 228fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // For FM set a value in Mhz and for AM set a value in Khz range 229fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // (channel). 230fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value.int32_array[2] = selector ? 99000000 : 100000; 231fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // For FM we have a sub-channel and we care about it, for AM pass 232fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // a dummy value. 233fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value.int32_array[3] = selector ? radio_preset : -1; 234fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 235fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 236fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 237fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal default: 238fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // actual implementation will be much complex than this. It should track proper last 239fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // state. Here just fill with zero. 240fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal memset(&(data->value), 0, sizeof(data->value)); 241fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 242fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 24308c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park ALOGI("vdev_get, type 0x%x, time %" PRId64 ", value_type %d", data->prop, data->timestamp, 244fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value_type); 245fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 246fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 247fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 248ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Parkstatic void vdev_release_memory_from_get(struct vehicle_hw_device* device UNUSED, 249ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park vehicle_prop_value_t *data) { 250ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park switch (data->value_type) { 251ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park case VEHICLE_VALUE_TYPE_STRING: 252ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park case VEHICLE_VALUE_TYPE_BYTES: 253ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park free(data->value.str_value.data); 254ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park data->value.str_value.data = NULL; 255ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park break; 256ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park default: 257ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park ALOGW("release_memory_from_get for property 0x%x which is not string or bytes type 0x%x" 258ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park , data->prop, data->value_type); 259ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park break; 260ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park } 261ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park} 262ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park 26308c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Parkstatic int vdev_set(vehicle_hw_device_t* device UNUSED, const vehicle_prop_value_t* data) { 264fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_set."); 265fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Just print what data will be setting here. 266fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Setting property %d with value type %d\n", data->prop, data->value_type); 267fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_prop_config_t* config = find_config(data->prop); 268fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (config == NULL) { 269fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_set: cannot find config 0x%x", data->prop); 270fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 271fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 272fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (config->value_type != data->value_type) { 273fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_set: type mismatch, passed 0x%x expecting 0x%x", data->value_type, 274fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal config->value_type); 275fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 276fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 277fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal switch (data->value_type) { 278fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_VALUE_TYPE_FLOAT: 279fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type: FLOAT\nValue: %f\n", data->value.float_value); 280fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 281fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_VALUE_TYPE_INT32: 282fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type: INT32\nValue: %d\n", data->value.int32_value); 283fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 284fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_VALUE_TYPE_INT64: 285fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type: INT64\nValue: %lld\n", data->value.int64_value); 286fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 287fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_VALUE_TYPE_BOOLEAN: 288fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type: BOOLEAN\nValue: %d\n", data->value.boolean_value); 289fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 290fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_VALUE_TYPE_STRING: 291fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type: STRING\n Size: %d\n", data->value.str_value.len); 292fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // NOTE: We only handle ASCII strings here. 293fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Print the UTF-8 string. 294fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal char *ascii_out = (char *) malloc ((data->value.str_value.len + 1) * sizeof (char)); 295fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal memcpy(ascii_out, data->value.str_value.data, data->value.str_value.len); 296fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ascii_out[data->value.str_value.len] = '\0'; 297fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value: %s\n", ascii_out); 298fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 299fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_VALUE_TYPE_INT32_VEC4: 300fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type: INT32_VEC4\nValue[0]: %d Value[1] %d Value[2] %d Value[3] %d", 301fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value.int32_array[0], data->value.int32_array[1], 302fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal data->value.int32_array[2], data->value.int32_array[3]); 303fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 304fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal default: 305fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("Value type not yet handled: %d.\n", data->value_type); 306fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 307fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 308fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 309fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 31008c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Parkvoid print_subscribe_info(vehicle_device_impl_t* impl UNUSED) { 31108c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park unsigned int i; 312fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal for (i = 0; i < sizeof(CONFIGS) / sizeof(vehicle_prop_config_t); i++) { 313fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal subscription_t* sub = (subscription_t*)CONFIGS[i].hal_data; 314fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (sub != NULL) { 3154529d7e262912ddb5569bc7fb729d59311c4dc29keunyoung ALOGD("prop: %d rate: %f", sub->prop, sub->sample_rate); 316fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 317fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 318fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 319fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 320fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal// This should be run in a separate thread always. 321fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalvoid fake_event_thread(struct subscription *sub) { 322fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (!sub) { 323fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("oops! subscription object cannot be NULL."); 324fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal exit(-1); 325fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 326fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal prctl(PR_SET_NAME, (unsigned long)sub->name, 0, 0, 0); 327fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Emit values in a loop, every 2 seconds. 328fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal while (1) { 329fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Create a random value depending on the property type. 330fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_prop_value_t event; 331fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.prop = sub->prop; 332fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.timestamp = elapsedRealtimeNano(); 333fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal switch (sub->prop) { 334fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_DRIVING_STATUS: 335fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value_type = VEHICLE_VALUE_TYPE_INT32; 336fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal switch ((event.timestamp & 0x30000000)>>28) { 337fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 0: 338fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.driving_status = VEHICLE_DRIVING_STATUS_UNRESTRICTED; 339fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 340fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 1: 341fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.driving_status = VEHICLE_DRIVING_STATUS_NO_VIDEO; 342fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 343fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 2: 344fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.driving_status = VEHICLE_DRIVING_STATUS_NO_KEYBOARD_INPUT; 345fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 346fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal default: 347fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.driving_status = VEHICLE_DRIVING_STATUS_NO_CONFIG; 348fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 349fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 350fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_GEAR_SELECTION: 351fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value_type = VEHICLE_VALUE_TYPE_INT32; 352fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal switch ((event.timestamp & 0x30000000)>>28) { 353fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 0: 35477761e24f9b82101ec78ed55b93d3371741dfc4eKeun-young Park event.value.gear_selection = VEHICLE_GEAR_PARK; 355fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 356fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 1: 357fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.gear_selection = VEHICLE_GEAR_NEUTRAL; 358fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 359fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 2: 360fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.gear_selection = VEHICLE_GEAR_DRIVE; 361fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 362fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case 3: 363fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.gear_selection = VEHICLE_GEAR_REVERSE; 364fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 365fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 366fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 367fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_PARKING_BRAKE_ON: 368fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value_type = VEHICLE_VALUE_TYPE_BOOLEAN; 369fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (event.timestamp & 0x20000000) { 370fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.parking_brake = VEHICLE_FALSE; 371fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else { 372fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.parking_brake = VEHICLE_TRUE; 373fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 374fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 375fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_PERF_VEHICLE_SPEED: 376fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value_type = VEHICLE_VALUE_TYPE_FLOAT; 377fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value.vehicle_speed = (float) ((event.timestamp & 0xff000000)>>24); 378fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 379fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal case VEHICLE_PROPERTY_RADIO_PRESET: 380fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal event.value_type = VEHICLE_VALUE_TYPE_INT32_VEC4; 381fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int presetInfo1[4] = {1 /* preset number */, 0 /* AM Band */, 1000, 0}; 382fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int presetInfo2[4] = {2 /* preset number */, 1 /* FM Band */, 1000, 0}; 383fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (event.timestamp & 0x20000000) { 384fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal memcpy(event.value.int32_array, presetInfo1, sizeof(presetInfo1)); 385fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else { 386fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal memcpy(event.value.int32_array, presetInfo2, sizeof(presetInfo2)); 387fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 388fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal break; 389fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal default: // unsupported 390bf877a7e6673f43ded94ead0784c93c558e5aa2bKeun-young Park if (sub->impl == NULL) { 391bf877a7e6673f43ded94ead0784c93c558e5aa2bKeun-young Park ALOGE("subscription impl NULL"); 392bf877a7e6673f43ded94ead0784c93c558e5aa2bKeun-young Park return; 393bf877a7e6673f43ded94ead0784c93c558e5aa2bKeun-young Park } 394fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (sub->impl->error_fn_ != NULL) { 395ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park sub->impl->error_fn_(-EINVAL, VEHICLE_PROPERTY_INVALID, 396fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal VEHICLE_OPERATION_GENERIC); 397fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else { 398fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("Error function is null"); 399fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 400fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("Unsupported prop 0x%x, quit", sub->prop); 401fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return; 402fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 403fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (sub->impl->event_fn_ != NULL) { 404fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->impl->event_fn_(&event); 405fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else { 406fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("Event function is null"); 407fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return; 408fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 409fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&sub->lock); 410fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (sub->stop_thread) { 411fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("exiting subscription request here."); 412fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Do any cleanup here. 413fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&sub->lock); 4144529d7e262912ddb5569bc7fb729d59311c4dc29keunyoung return; 415fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 416fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal struct timespec now; 417fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal clock_gettime(CLOCK_REALTIME, &now); 418fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal now.tv_sec += 1; // sleep for one sec 419fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_cond_timedwait(&sub->cond, &sub->lock, &now); 420fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&sub->lock); 421fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 422fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 423fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 424bf877a7e6673f43ded94ead0784c93c558e5aa2bKeun-young Parkstatic int vdev_subscribe(vehicle_hw_device_t* device, int32_t prop, float sample_rate, 42577761e24f9b82101ec78ed55b93d3371741dfc4eKeun-young Park int32_t zones UNUSED) { 426fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_subscribe 0x%x, %f", prop, sample_rate); 427fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* impl = (vehicle_device_impl_t*)device; 428fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Check that the device is initialized. 429fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&lock_); 430fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (!impl->initialized_) { 431fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 432fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_subscribe: have you called init()?"); 433fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 434fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 435fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_prop_config_t* config = find_config(prop); 436fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (config == NULL) { 437fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 438fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_subscribe not supported property 0x%x", prop); 439fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 440fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 441fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if ((config->access != VEHICLE_PROP_ACCESS_READ) && 442fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal (config->access != VEHICLE_PROP_ACCESS_READ_WRITE)) { 443fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 444fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_subscribe read not supported on the property 0x%x", prop); 445fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 446fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 447fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (config->change_mode == VEHICLE_PROP_CHANGE_MODE_STATIC) { 448fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 449fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_subscribe cannot subscribe static property 0x%x", prop); 450fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 451fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 452fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if ((config->change_mode == VEHICLE_PROP_CHANGE_MODE_ON_CHANGE) && (sample_rate != 0)) { 453fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 454fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_subscribe on change type should have 0 sample rate, property 0x%x, sample rate %f", 455fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal prop, sample_rate); 456fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 457fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 458fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if ((config->max_sample_rate < sample_rate) || (config->min_sample_rate > sample_rate)) { 459fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 460fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGE("vdev_subscribe property 0x%x, invalid sample rate %f, min:%f, max:%f", 461fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal prop, sample_rate, config->min_sample_rate, config->max_sample_rate); 462fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 463fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 464fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 465fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal subscription_t* sub = (subscription_t*)config->hal_data; 466fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (sub == NULL) { 467fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub = calloc(1, sizeof(subscription_t)); 468fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->prop = prop; 469fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->sample_rate = sample_rate; 470fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->stop_thread = 0; 471fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->impl = impl; 472fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_init(&sub->lock, NULL); 473fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_cond_init(&sub->cond, NULL); 474fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal config->hal_data = sub; 475fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sprintf(sub->name, "vhal0x%x", prop); 476fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else if (sub->sample_rate != sample_rate){ // sample rate changed 477fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal //TODO notify this to fake sensor thread 478fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->sample_rate = sample_rate; 479fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 480fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 481fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 482fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal int ret_code = pthread_create( 48308c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Park &sub->thread, NULL, (void *(*)(void*))fake_event_thread, sub); 484fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal print_subscribe_info(impl); 485fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 486fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 487fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 488fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 489fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic int vdev_unsubscribe(vehicle_hw_device_t* device, int32_t prop) { 490fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_unsubscribe 0x%x", prop); 491fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* impl = (vehicle_device_impl_t*)device; 492fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&lock_); 493fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_prop_config_t* config = find_config(prop); 494fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (config == NULL) { 495fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 496fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 497fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 498fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal subscription_t* sub = (subscription_t*)config->hal_data; 499fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (sub == NULL) { 500fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 501fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -EINVAL; 502fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 503fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal config->hal_data = NULL; 504fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 505fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&sub->lock); 506fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal sub->stop_thread = 1; 507fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_cond_signal(&sub->cond); 508fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&sub->lock); 509fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_join(sub->thread, NULL); 510fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_cond_destroy(&sub->cond); 511fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_destroy(&sub->lock); 512fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal free(sub); 513fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_lock(&lock_); 514fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal print_subscribe_info(impl); 515fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal pthread_mutex_unlock(&lock_); 516fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 517fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 518fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 519fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic int vdev_close(hw_device_t* device) { 520fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* impl = (vehicle_device_impl_t*)device; 521fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (impl) { 522fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal free(impl); 523fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 524fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } else { 525fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -1; 526fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 527fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 528fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 529418c7e8fc981d282d15f0b5a9c8979b696842671Keun-young Parkstatic int vdev_dump(struct vehicle_hw_device* device UNUSED, int fd UNUSED) { 530418c7e8fc981d282d15f0b5a9c8979b696842671Keun-young Park //TODO 531418c7e8fc981d282d15f0b5a9c8979b696842671Keun-young Park return 0; 532418c7e8fc981d282d15f0b5a9c8979b696842671Keun-young Park} 533418c7e8fc981d282d15f0b5a9c8979b696842671Keun-young Park 534fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal/* 535fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * The open function is provided as an interface in harwdare.h which fills in 536fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * all the information about specific implementations and version specific 537fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * informations in hw_device_t structure. After calling open() the client should 538fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * use the hw_device_t to execute any Vehicle HAL device specific functions. 539fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal */ 54008c255e3b66577d87a2e8209e94b343fad9ff0eaKeun-young Parkstatic int vdev_open(const hw_module_t* module, const char* name UNUSED, 541fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal hw_device_t** device) { 542fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal ALOGD("vdev_open"); 543fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 544fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Oops, out of memory! 545fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vehicle_device_impl_t* vdev = calloc(1, sizeof(vehicle_device_impl_t)); 546fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal if (vdev == NULL) { 547fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return -ENOMEM; 548fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal } 549fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 550fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Common functions provided by harware.h to access module and device(s). 551fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.common.tag = HARDWARE_DEVICE_TAG; 552fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.common.version = VEHICLE_DEVICE_API_VERSION_1_0; 553fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.common.module = (hw_module_t *) module; 554fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.common.close = vdev_close; 555fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 556fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal // Define the Vehicle HAL device specific functions. 557fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.list_properties = vdev_list_properties; 558fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.init = vdev_init; 559fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.release = vdev_release; 560fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.get = vdev_get; 561ab68e37c35459a4b97b585759f159a139a8436d2Keun-young Park vdev->vehicle_device.release_memory_from_get = vdev_release_memory_from_get; 562fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.set = vdev_set; 563fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.subscribe = vdev_subscribe; 564fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal vdev->vehicle_device.unsubscribe = vdev_unsubscribe; 565418c7e8fc981d282d15f0b5a9c8979b696842671Keun-young Park vdev->vehicle_device.dump = vdev_dump; 566fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 567fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal *device = (hw_device_t *) vdev; 568fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal return 0; 569fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal} 570fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 571fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalstatic struct hw_module_methods_t hal_module_methods = { 572fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .open = vdev_open, 573fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal}; 574fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal 575fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal/* 576fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * This structure is mandatory to be implemented by each HAL implementation. It 577fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * exposes the open method (see hw_module_methods_t above) which opens a device. 578fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * The vehicle HAL is supposed to be used as a single device HAL hence all the 579fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * functions should be implemented inside of the vehicle_hw_device_t struct (see 580fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal * the vehicle.h in include/ folder. 581fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal */ 582fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwalvehicle_module_t HAL_MODULE_INFO_SYM = { 583fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .common = { 584fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .tag = HARDWARE_MODULE_TAG, 585fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .module_api_version = VEHICLE_MODULE_API_VERSION_1_0, 586fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .hal_api_version = HARDWARE_HAL_API_VERSION, 587fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .id = VEHICLE_HARDWARE_MODULE_ID, 588fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .name = "Default vehicle HW HAL", 589fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .author = "", 590fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal .methods = &hal_module_methods, 591fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal }, 592fb63668a8a4eab5a0ba32132405c7982629074a1Sanket Agarwal}; 593