From ac135b66fb258b669dbcf4608a9ea7f386c00386 Mon Sep 17 00:00:00 2001 From: Paul Kocialkowski Date: Tue, 14 Jan 2014 15:57:09 +0100 Subject: SMDK4x12 Sensors Signed-off-by: Paul Kocialkowski --- sensors/ssp.c | 76 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 76 insertions(+) create mode 100644 sensors/ssp.c (limited to 'sensors/ssp.c') diff --git a/sensors/ssp.c b/sensors/ssp.c new file mode 100644 index 0000000..d1d4ae1 --- /dev/null +++ b/sensors/ssp.c @@ -0,0 +1,76 @@ +/* + * Copyright (C) 2014 Paul Kocialkowski + * + * 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 3 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. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see . + */ + +#include +#include + +#include +#include + +#define LOG_TAG "smdk4x12_sensors" +#include + +#include "smdk4x12_sensors.h" +#include "ssp.h" + +int ssp_sensor_enable(int sensor_type) +{ + char path_enable[PATH_MAX] = "/sys/class/sensors/ssp_sensor/enable"; + int value; + int rc; + + ALOGD("%s(%d)", __func__, sensor_type); + + if (sensor_type < 0 || sensor_type >= SENSOR_FACTORY_MAX) + return -EINVAL; + + value = sysfs_value_read(path_enable); + if (value < 0) + value = 0; + + value |= (1 << sensor_type); + + rc = sysfs_value_write(path_enable, value); + if (rc < 0) + return -1; + + return 0; +} + +int ssp_sensor_disable(int sensor_type) +{ + char path_enable[PATH_MAX] = "/sys/class/sensors/ssp_sensor/enable"; + int value; + int rc; + + ALOGD("%s(%d)", __func__, sensor_type); + + if (sensor_type < 0 || sensor_type >= SENSOR_FACTORY_MAX) + return -EINVAL; + + value = sysfs_value_read(path_enable); + if (value < 0) + value = 0; + + value &= ~(1 << sensor_type); + + rc = sysfs_value_write(path_enable, value); + if (rc < 0) + return -1; + + return 0; +} -- cgit v1.2.3