static ssize_t act_store_active(struct device* dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct act_context *cxt = NULL;
ACT_LOG("act_store_active buf=%s\n",buf);
mutex_lock(&act_context_obj->act_op_mutex);
cxt = act_context_obj;
if(NULL == cxt->act_ctl.open_report_data)
{
ACT_LOG("act_ctl enable NULL\n");
mutex_unlock(&act_context_obj->act_op_mutex);
return count;
}
if (!strncmp(buf, "1", 1))
{
act_enable_data(1);
}
else if (!strncmp(buf, "0", 1))
{
act_enable_data(0);
}
else
{
ACT_ERR(" act_store_active error !!\n");
}
mutex_unlock(&act_context_obj->act_op_mutex);
ACT_LOG(" act_store_active done\n");
return count;
}
static ssize_t act_store_enable_nodata(struct device* dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct act_context *cxt = NULL;
//int err =0;
ACT_LOG("act_store_enable nodata buf=%s\n",buf);
mutex_lock(&act_context_obj->act_op_mutex);
cxt = act_context_obj;
if(NULL == cxt->act_ctl.enable_nodata)
{
ACT_LOG("act_ctl enable nodata NULL\n");
mutex_unlock(&act_context_obj->act_op_mutex);
return count;
}
if (!strncmp(buf, "1", 1))
{
act_enable_nodata(1);
}
else if (!strncmp(buf, "0", 1))
{
act_enable_nodata(0);
}
else
{
ACT_ERR(" act_store enable nodata cmd error !!\n");
}
mutex_unlock(&act_context_obj->act_op_mutex);
return count;
}
static int act_real_driver_init(void)
{
int i =0;
int err=0;
ACT_LOG(" act_real_driver_init +\n");
for(i = 0; i < MAX_CHOOSE_ACT_NUM; i++)
{
ACT_LOG(" i=%d\n",i);
if(0 != activity_init_list[i])
{
ACT_LOG(" act try to init driver %s\n", activity_init_list[i]->name);
err = activity_init_list[i]->init();
if(0 == err)
{
ACT_LOG(" act real driver %s probe ok\n", activity_init_list[i]->name);
break;
}
}
}
if(i == MAX_CHOOSE_ACT_NUM)
{
ACT_LOG(" act_real_driver_init fail\n");
err=-1;
}
return err;
}
static ssize_t act_store_delay(struct device* dev, struct device_attribute *attr,
const char *buf, size_t count)
{
// struct act_context *devobj = (struct act_context*)dev_get_drvdata(dev);
int delay;
int mdelay=0;
struct act_context *cxt = NULL;
//int err =0;
mutex_lock(&act_context_obj->act_op_mutex);
cxt = act_context_obj;
if(NULL == cxt->act_ctl.set_delay)
{
ACT_LOG("act_ctl set_delay NULL\n");
mutex_unlock(&act_context_obj->act_op_mutex);
return count;
}
if (1 != sscanf(buf, "%d", &delay)) {
ACT_ERR("invalid format!!\n");
mutex_unlock(&act_context_obj->act_op_mutex);
return count;
}
if(false == cxt->act_ctl.is_report_input_direct)
{
mdelay = (int)delay/1000/1000;
atomic_set(&act_context_obj->delay, mdelay);
}
cxt->act_ctl.set_delay(delay);
ACT_LOG(" act_delay %d ns\n",delay);
mutex_unlock(&act_context_obj->act_op_mutex);
return count;
}
static ssize_t act_store_batch(struct device* dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct act_context *cxt = NULL;
//int err =0;
ACT_LOG("act_store_batch buf=%s\n",buf);
mutex_lock(&act_context_obj->act_op_mutex);
cxt = act_context_obj;
if(cxt->act_ctl.is_support_batch){
if (!strncmp(buf, "1", 1))
{
cxt->is_batch_enable = true;
}
else if (!strncmp(buf, "0", 1))
{
cxt->is_batch_enable = false;
}
else
{
ACT_ERR(" act_store_batch error !!\n");
}
}else{
ACT_LOG(" act_store_batch not support\n");
}
mutex_unlock(&act_context_obj->act_op_mutex);
ACT_LOG(" act_store_batch done: %d\n", cxt->is_batch_enable);
return count;
}
static int act_enable_data(int enable)
{
struct act_context *cxt = NULL;
cxt = act_context_obj;
if(NULL == cxt->act_ctl.open_report_data)
{
ACT_ERR("no act control path\n");
return -1;
}
if(1 == enable)
{
ACT_LOG("act enable data\n");
cxt->is_active_data =true;
cxt->is_first_data_after_enable = true;
cxt->act_ctl.open_report_data(1);
if(false == cxt->is_polling_run && cxt->is_batch_enable == false)
{
if(false == cxt->act_ctl.is_report_input_direct)
{
mod_timer(&cxt->timer, jiffies + atomic_read(&cxt->delay)/(1000/HZ));
cxt->is_polling_run = true;
}
}
}
if(0 == enable)
{
ACT_LOG("act disable \n");
cxt->is_active_data =false;
cxt->act_ctl.open_report_data(0);
if(true == cxt->is_polling_run)
{
if(false == cxt->act_ctl.is_report_input_direct)
{
cxt->is_polling_run = false;
del_timer_sync(&cxt->timer);
cancel_work_sync(&cxt->report);
cxt->drv_data.act_data.values[0] = ACT_INVALID_VALUE;
cxt->drv_data.act_data.values[1] = ACT_INVALID_VALUE;
cxt->drv_data.act_data.values[2] = ACT_INVALID_VALUE;
cxt->drv_data.act_data.values[3] = ACT_INVALID_VALUE;
cxt->drv_data.act_data.values[4] = ACT_INVALID_VALUE;
cxt->drv_data.act_data.values[5] = ACT_INVALID_VALUE;
}
}
}
act_real_enable(enable);
return 0;
}
/*----------------------------------------------------------------------------*/
static ssize_t act_show_active(struct device* dev,
struct device_attribute *attr, char *buf)
{
struct act_context *cxt = NULL;
int div = 0;
cxt = act_context_obj;
//int len = 0;
ACT_LOG("act show active not support now\n");
//div=cxt->act_data.vender_div;
ACT_LOG("act vender_div value: %d\n", div);
return snprintf(buf, PAGE_SIZE, "%d\n", div);
//return len;
}
static ssize_t act_show_delay(struct device* dev,
struct device_attribute *attr, char *buf)
{
int len = 0;
ACT_LOG(" not support now\n");
return len;
}
int act_driver_add(struct act_init_info* obj)
{
int err=0;
int i =0;
ACT_FUN(f);
for(i =0; i < MAX_CHOOSE_ACT_NUM; i++ )
{
if(i == 0){
ACT_LOG("register act driver for the first time\n");
if(platform_driver_register(&activity_driver))
{
ACT_ERR("failed to register act driver already exist\n");
}
}
if(NULL == activity_init_list[i])
{
obj->platform_diver_addr = &activity_driver;
activity_init_list[i] = obj;
break;
}
}
if(NULL==activity_init_list[i])
{
ACT_ERR("act driver add err \n");
err=-1;
}
return err;
}
static int act_real_enable(int enable)
{
int err =0;
struct act_context *cxt = NULL;
cxt = act_context_obj;
if(1==enable)
{
if(true==cxt->is_active_data || true ==cxt->is_active_nodata)
{
err = cxt->act_ctl.enable_nodata(1);
if(err)
{
err = cxt->act_ctl.enable_nodata(1);
if(err)
{
err = cxt->act_ctl.enable_nodata(1);
if(err)
ACT_ERR("act enable(%d) err 3 timers = %d\n", enable, err);
}
}
ACT_LOG("act real enable \n" );
}
}
if(0==enable)
{
if(false==cxt->is_active_data && false ==cxt->is_active_nodata)
{
err = cxt->act_ctl.enable_nodata(0);
if(err)
{
ACT_ERR("act enable(%d) err = %d\n", enable, err);
}
ACT_LOG("act real disable \n" );
}
}
return err;
}
static struct act_context *act_context_alloc_object(void)
{
struct act_context *obj = kzalloc(sizeof(*obj), GFP_KERNEL);
ACT_LOG("act_context_alloc_object++++\n");
if(!obj)
{
ACT_ERR("Alloc act object error!\n");
return NULL;
}
atomic_set(&obj->delay, 200); /*5Hz*/// set work queue delay time 200ms
atomic_set(&obj->wake, 0);
INIT_WORK(&obj->report, act_work_func);
init_timer(&obj->timer);
obj->timer.expires = jiffies + atomic_read(&obj->delay)/(1000/HZ);
obj->timer.function = act_poll;
obj->timer.data = (unsigned long)obj;
obj->is_first_data_after_enable = false;
obj->is_polling_run = false;
obj->is_batch_enable = false;
mutex_init(&obj->act_op_mutex);
ACT_LOG("act_context_alloc_object----\n");
return obj;
}
int act_register_data_path(struct act_data_path *data)
{
struct act_context *cxt = NULL;
//int err =0;
cxt = act_context_obj;
cxt->act_data.get_data = data->get_data;
//cxt->act_data.vender_div = data->vender_div;
//cxt->act_data.get_raw_data = data->get_raw_data;
//ACT_LOG("act register data path vender_div: %d\n", cxt->act_data.vender_div);
if(NULL == cxt->act_data.get_data)
{
ACT_LOG("act register data path fail \n");
return -1;
}
return 0;
}
int act_data_report(hwm_sensor_data data,int status)
{
//ACT_LOG("+act_data_report! %d, %d, %d, %d\n",x,y,z,status);
ACT_LOG("+act_data_report! %d, %d, %d, %d %d %d\n",
data.values[0], data.values[1], data.values[2], data.values[3], data.values[4], data.values[5]);
struct act_context *cxt = NULL;
int err =0;
cxt = act_context_obj;
input_report_abs(cxt->idev, EVENT_TYPE_ACT_IN_VEHICLE, data.values[0]);
input_report_abs(cxt->idev, EVENT_TYPE_ACT_ON_BICYCLE, data.values[1]);
input_report_abs(cxt->idev, EVENT_TYPE_ACT_ON_FOOT, data.values[2]);
input_report_abs(cxt->idev, EVENT_TYPE_ACT_STILL, data.values[3]);
input_report_abs(cxt->idev, EVENT_TYPE_ACT_UNKNOWN, data.values[4]);
input_report_abs(cxt->idev, EVENT_TYPE_ACT_TILT, data.values[5]);
input_report_abs(cxt->idev, EVENT_TYPE_ACT_STATUS, status);
input_sync(cxt->idev);
return err;
}
int act_register_control_path(struct act_control_path *ctl)
{
struct act_context *cxt = NULL;
int err =0;
cxt = act_context_obj;
cxt->act_ctl.set_delay = ctl->set_delay;
cxt->act_ctl.open_report_data= ctl->open_report_data;
cxt->act_ctl.enable_nodata = ctl->enable_nodata;
cxt->act_ctl.is_support_batch = ctl->is_support_batch;
if(NULL==cxt->act_ctl.set_delay || NULL==cxt->act_ctl.open_report_data
|| NULL==cxt->act_ctl.enable_nodata)
{
ACT_LOG("act register control path fail \n");
return -1;
}
//add misc dev for sensor hal control cmd
err = act_misc_init(act_context_obj);
if(err)
{
ACT_ERR("unable to register act misc device!!\n");
return -2;
}
err = sysfs_create_group(&act_context_obj->mdev.this_device->kobj,
&act_attribute_group);
if (err < 0)
{
ACT_ERR("unable to create act attribute file\n");
return -3;
}
kobject_uevent(&act_context_obj->mdev.this_device->kobj, KOBJ_ADD);
return 0;
}
static int act_probe(struct platform_device *pdev)
{
int err;
ACT_LOG("+++++++++++++act_probe!!\n");
act_context_obj = act_context_alloc_object();
if (!act_context_obj)
{
err = -ENOMEM;
ACT_ERR("unable to allocate devobj!\n");
goto exit_alloc_data_failed;
}
//init real acteleration driver
err = act_real_driver_init();
if(err)
{
ACT_ERR("act real driver init fail\n");
goto real_driver_init_fail;
}
//err = act_factory_device_init();
//if(err)
//{
// ACT_ERR("act_factory_device_init fail\n");
//}
//init input dev
err = act_input_init(act_context_obj);
if(err)
{
ACT_ERR("unable to register act input device!\n");
goto exit_alloc_input_dev_failed;
}
#if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND)
atomic_set(&(act_context_obj->early_suspend), 0);
act_context_obj->early_drv.level = EARLY_SUSPEND_LEVEL_STOP_DRAWING - 1,
act_context_obj->early_drv.suspend = act_early_suspend,
act_context_obj->early_drv.resume = act_late_resume,
register_early_suspend(&act_context_obj->early_drv);
#endif //#if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND)
ACT_LOG("----act_probe OK !!\n");
return 0;
//exit_hwmsen_create_attr_failed:
//exit_misc_register_failed:
//exit_err_sysfs:
if (err)
{
ACT_ERR("sysfs node creation error \n");
act_input_destroy(act_context_obj);
}
real_driver_init_fail:
exit_alloc_input_dev_failed:
kfree(act_context_obj);
exit_alloc_data_failed:
ACT_LOG("----act_probe fail !!!\n");
return err;
}
static int activity_probe(struct platform_device *pdev)
{
ACT_LOG("activity_probe\n");
return 0;
}
/*----------------------------------------------------------------------------*/
static void act_late_resume(struct early_suspend *h)
{
atomic_set(&(act_context_obj->early_suspend), 0);
ACT_LOG(" act_late_resume ok------->hwm_obj->early_suspend=%d \n",atomic_read(&(act_context_obj->early_suspend)));
return ;
}
void MainDialog::Notify()
{
if (mpAppProfilePanel->GetEnabled())
{
if (mpAppProfilePanel->GetActiveProfile().IsEmpty())
{
ProfileList AppProfiles = mpAppProfilePanel->GetProfiles();
ProfileList::iterator it;
int index = 0;
for (it = AppProfiles.begin(); it != AppProfiles.end(); ++it)
{
if (IsAppRunning((*it).AppName))
{
if (LoadXML((*it).ProfileName))
{
ACT_LOG("Profile: " << (*it).AppName.ToUTF8() << ", " << (*it).ProfileName.ToUTF8() << " activated");
mpAppProfilePanel->SetActiveProfile((*it).AppName);
mpAppProfilePanel->SetActiveProfileIndex(index);
mpAppProfilePanel->UpdateDisplay();
Stop();
Start(5*TIMER_INTERVAL);
}
else
{
ERR_LOG("Failed to load profile " << (*it).AppName.ToUTF8());
}
}
++index;
}
}
else
{
if (!IsAppRunning(mpAppProfilePanel->GetActiveProfile()))
{
ACT_LOG(mpAppProfilePanel->GetActiveProfile().ToUTF8() << " closed.");
if (mpAppProfilePanel->GetDefaultProfile().IsEmpty())
{
mpFanSpeedPanel->SetDefaultFanSpeed();
mpAppProfilePanel->SetActiveProfile(wxT(""));
mpAppProfilePanel->SetActiveProfileIndex(-1);
mpAppProfilePanel->UpdateDisplay();
}
else
{
ACT_LOG("Default Profile activated");
if (LoadXML(mpAppProfilePanel->GetDefaultProfile()))
{
mpAppProfilePanel->SetActiveProfile(wxT(""));
mpAppProfilePanel->SetActiveProfileIndex(-1);
mpAppProfilePanel->UpdateDisplay();
}
else
{
ERR_LOG("Failed to load default profile " << mpAppProfilePanel->GetDefaultProfile().ToUTF8());
}
}
mpAppProfilePanel->SetActiveProfile(wxT(""));
Stop();
Start(TIMER_INTERVAL);
}
}
}
else if (!mpAppProfilePanel->GetManualProfile().IsEmpty())
{
ACT_LOG("Profile: " << mpAppProfilePanel->GetManualProfile().ToUTF8() << " activated.");
if (LoadXML(mpAppProfilePanel->GetManualProfile()))
{
mpAppProfilePanel->SetManualProfile(wxT(""));
}
else
{
ERR_LOG("Failed to load manual selected profile " << mpAppProfilePanel->GetManualProfile().ToUTF8());
}
Stop();
Start(TIMER_INTERVAL);
}
}
static void act_work_func(struct work_struct *work)
{
struct act_context *cxt = NULL;
//int out_size;
//hwm_sensor_data sensor_data;
//u64 data64[6]; //for unify get_data parameter type
//u16 data32[6]; //for hwm_sensor_data.values as int
u16 data16[6]; //for hwm_sensor_data.values as int
int status;
int64_t nt;
struct timespec time;
int err = 0;
cxt = act_context_obj;
if(NULL == cxt->act_data.get_data)
{
ACT_ERR("act driver not register data path\n");
}
time.tv_sec = time.tv_nsec = 0;
time = get_monotonic_coarse();
nt = time.tv_sec*1000000000LL+time.tv_nsec;
//add wake lock to make sure data can be read before system suspend
//initial data
ACT_LOG("act_data.values %d,%d,%d,%d,%d,%d \n" ,
cxt->drv_data.act_data.values[0],
cxt->drv_data.act_data.values[1],
cxt->drv_data.act_data.values[2],
cxt->drv_data.act_data.values[3],
cxt->drv_data.act_data.values[4],
cxt->drv_data.act_data.values[5]);
err = cxt->act_data.get_data(data16,&status);
ACT_LOG("get_data 16 %d,%d,%d,%d,%d,%d \n" ,
data16[0],data16[1],data16[2],data16[3],data16[4],data16[5]);
if(err)
{
ACT_ERR("get act data fails!!\n" );
goto act_loop;
}
else
{
if((data16[0] == cxt->drv_data.act_data.values[0])
&& (data16[1] == cxt->drv_data.act_data.values[1])
&& (data16[2] == cxt->drv_data.act_data.values[2])
&& (data16[3] == cxt->drv_data.act_data.values[3])
&& (data16[4] == cxt->drv_data.act_data.values[4])
&& (data16[5] == cxt->drv_data.act_data.values[5]))
{
goto act_loop;
}
else
{
cxt->drv_data.act_data.values[0] = data16[0];
cxt->drv_data.act_data.values[1] = data16[1];
cxt->drv_data.act_data.values[2] = data16[2];
cxt->drv_data.act_data.values[3] = data16[3];
cxt->drv_data.act_data.values[4] = data16[4];
cxt->drv_data.act_data.values[5] = data16[5];
ACT_LOG("act values %d,%d,%d,%d,%d,%d\n" ,
cxt->drv_data.act_data.values[0],
cxt->drv_data.act_data.values[1],
cxt->drv_data.act_data.values[2],
cxt->drv_data.act_data.values[3],
cxt->drv_data.act_data.values[4],
cxt->drv_data.act_data.values[5]);
cxt->drv_data.act_data.status = status;
cxt->drv_data.act_data.time = nt;
}
}
if(true == cxt->is_first_data_after_enable)
{
cxt->is_first_data_after_enable = false;
//filter -1 value
if( ACT_INVALID_VALUE == cxt->drv_data.act_data.values[0] ||
ACT_INVALID_VALUE == cxt->drv_data.act_data.values[1] ||
ACT_INVALID_VALUE == cxt->drv_data.act_data.values[2] ||
ACT_INVALID_VALUE == cxt->drv_data.act_data.values[3] ||
ACT_INVALID_VALUE == cxt->drv_data.act_data.values[4] ||
ACT_INVALID_VALUE == cxt->drv_data.act_data.values[5] )
{
ACT_LOG(" read invalid data \n");
goto act_loop;
}
}
//report data to input device
//printk("new act work run....\n");
//ACT_LOG("act data[%d,%d,%d] \n" ,cxt->drv_data.act_data.values[0],
//cxt->drv_data.act_data.values[1],cxt->drv_data.act_data.values[2]);
act_data_report(cxt->drv_data.act_data, cxt->drv_data.act_data.status);
act_loop:
if(true == cxt->is_polling_run)
{
{
mod_timer(&cxt->timer, jiffies + atomic_read(&cxt->delay)/(1000/HZ));
}
}
}