You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 

215 lines
6.5 KiB

/*
* Copyright (C) 2012, Samsung Electronics Co. Ltd. All Rights Reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#include <linux/init.h>
#include <linux/module.h>
#include "adsp.h"
#define VENDOR "YAMAHA"
#define CHIP_ID "YAS539"
#define MAG_ST_TRY_CNT 3
static ssize_t mag_vendor_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return snprintf(buf, PAGE_SIZE, "%s\n", VENDOR);
}
static ssize_t mag_name_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return snprintf(buf, PAGE_SIZE, "%s\n", CHIP_ID);
}
static ssize_t mag_raw_data_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adsp_data *data = dev_get_drvdata(dev);
uint8_t cnt = 0;
adsp_unicast(NULL, 0, MSG_MAG, 0, MSG_TYPE_GET_RAW_DATA);
while (!(data->ready_flag[MSG_TYPE_GET_RAW_DATA] & 1 << MSG_MAG) &&
cnt++ < TIMEOUT_CNT)
usleep_range(500, 550);
data->ready_flag[MSG_TYPE_GET_RAW_DATA] &= ~(1 << MSG_MAG);
if (cnt >= TIMEOUT_CNT) {
pr_err("[FACTORY] %s: Timeout!!!\n", __func__);
return snprintf(buf, PAGE_SIZE, "0,0,0\n");
}
return snprintf(buf, PAGE_SIZE, "%d,%d,%d\n",
data->msg_buf[MSG_MAG][0],
data->msg_buf[MSG_MAG][1],
data->msg_buf[MSG_MAG][2]);
}
static ssize_t mag_raw_data_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_FACTORY_ENABLE);
msleep(20);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_SET_CAL_DATA);
msleep(20);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_FACTORY_DISABLE);
return size;
}
static ssize_t mag_selttest_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adsp_data *data = dev_get_drvdata(dev);
uint8_t cnt = 0;
int retry = 0, i;
RETRY_MAG_SELFTEST:
pr_info("[FACTORY] %s - start", __func__);
adsp_unicast(NULL, 0, MSG_MAG, 0, MSG_TYPE_ST_SHOW_DATA);
while (!(data->ready_flag[MSG_TYPE_ST_SHOW_DATA] & 1 << MSG_MAG) &&
cnt++ < TIMEOUT_CNT)
msleep(20);
data->ready_flag[MSG_TYPE_ST_SHOW_DATA] &= ~(1 << MSG_MAG);
if (cnt >= TIMEOUT_CNT) {
pr_err("[FACTORY] %s: Timeout!!!\n", __func__);
data->msg_buf[MSG_MAG][0] = -1;
}
if (!(data->msg_buf[MSG_MAG][0] == 0)) {
if (retry < MAG_ST_TRY_CNT) {
retry++;
for (i = 0; i < 10; i++)
data->msg_buf[MSG_MAG][i] = 0;
msleep(100);
pr_info("[FACTORY] %s - retry %d", __func__, retry);
goto RETRY_MAG_SELFTEST;
}
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_FACTORY_ENABLE);
msleep(20);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_SET_CAL_DATA);
msleep(20);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_FACTORY_DISABLE);
return snprintf(buf, PAGE_SIZE, "-1,0,0,0,0,0,0,0,0,0\n");
}
pr_info("[FACTORY] status=%d, sf_status=%d, sf_x=%d, sf_y=%d, sf_z=%d\n dac=%d, adc=%d, adc_x=%d, adc_y=%d, adc_z=%d\n",
data->msg_buf[MSG_MAG][0], data->msg_buf[MSG_MAG][1],
data->msg_buf[MSG_MAG][2], data->msg_buf[MSG_MAG][3],
data->msg_buf[MSG_MAG][4], data->msg_buf[MSG_MAG][5],
data->msg_buf[MSG_MAG][6], data->msg_buf[MSG_MAG][7],
data->msg_buf[MSG_MAG][8], data->msg_buf[MSG_MAG][9]);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_FACTORY_ENABLE);
msleep(20);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_SET_CAL_DATA);
msleep(20);
adsp_unicast(NULL, 0, MSG_MAG_CAL, 0, MSG_TYPE_FACTORY_DISABLE);
return snprintf(buf, PAGE_SIZE, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\n",
data->msg_buf[MSG_MAG][0], data->msg_buf[MSG_MAG][1],
data->msg_buf[MSG_MAG][2], data->msg_buf[MSG_MAG][3],
data->msg_buf[MSG_MAG][4], data->msg_buf[MSG_MAG][5],
data->msg_buf[MSG_MAG][6], data->msg_buf[MSG_MAG][7],
data->msg_buf[MSG_MAG][8], data->msg_buf[MSG_MAG][9]);
}
static ssize_t mag_dhr_sensor_info_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
#if 0
struct adsp_data *data = dev_get_drvdata(dev);
struct msg_data message;
uint8_t cnt = 0;
message.msg_type = MSG_MAG;
data->calib_ready_flag &= ~(1 << MSG_MAG);
adsp_unicast(&message, sizeof(message),
MSG_TYPE_GET_CALIB_DATA, 0, 0);
while (!(data->calib_ready_flag & 1 << MSG_MAG) &&
cnt++ < TIMEOUT_CNT)
msleep(20);
data->calib_ready_flag &= ~(1 << MSG_MAG);
if (cnt >= TIMEOUT_CNT)
pr_err("[FACTORY] %s: Timeout!!!\n", __func__);
pr_info("[FACTORY] %s\n", __func__);
pr_info("[FACTORY] 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
data->sensor_calib_data[MSG_MAG].si_mat[0],
data->sensor_calib_data[MSG_MAG].si_mat[1],
data->sensor_calib_data[MSG_MAG].si_mat[2],
data->sensor_calib_data[MSG_MAG].si_mat[3],
data->sensor_calib_data[MSG_MAG].si_mat[4],
data->sensor_calib_data[MSG_MAG].si_mat[5],
data->sensor_calib_data[MSG_MAG].si_mat[6],
data->sensor_calib_data[MSG_MAG].si_mat[7],
data->sensor_calib_data[MSG_MAG].si_mat[8]);
return snprintf(buf, PAGE_SIZE,
"\"SI_PARAMETER\":\"0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\"\n",
data->sensor_calib_data[MSG_MAG].si_mat[0],
data->sensor_calib_data[MSG_MAG].si_mat[1],
data->sensor_calib_data[MSG_MAG].si_mat[2],
data->sensor_calib_data[MSG_MAG].si_mat[3],
data->sensor_calib_data[MSG_MAG].si_mat[4],
data->sensor_calib_data[MSG_MAG].si_mat[5],
data->sensor_calib_data[MSG_MAG].si_mat[6],
data->sensor_calib_data[MSG_MAG].si_mat[7],
data->sensor_calib_data[MSG_MAG].si_mat[8]);
#endif
return 0;
}
static DEVICE_ATTR(name, 0444, mag_name_show, NULL);
static DEVICE_ATTR(vendor, 0444, mag_vendor_show, NULL);
static DEVICE_ATTR(raw_data, 0664, mag_raw_data_show, mag_raw_data_store);
static DEVICE_ATTR(selftest, 0440, mag_selttest_show, NULL);
static DEVICE_ATTR(dhr_sensor_info, 0440, mag_dhr_sensor_info_show, NULL);
static struct device_attribute *mag_attrs[] = {
&dev_attr_name,
&dev_attr_vendor,
&dev_attr_raw_data,
&dev_attr_selftest,
&dev_attr_dhr_sensor_info,
NULL,
};
static int __init yas539_factory_init(void)
{
adsp_factory_register(MSG_MAG, mag_attrs);
pr_info("[FACTORY] %s\n", __func__);
return 0;
}
static void __exit yas539_factory_exit(void)
{
adsp_factory_unregister(MSG_MAG);
pr_info("[FACTORY] %s\n", __func__);
}
module_init(yas539_factory_init);
module_exit(yas539_factory_exit);