Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 21bb23d1 authored by Laxminath Kasam's avatar Laxminath Kasam Committed by Sudheer Papothi
Browse files

ASoC: wsa881x: Add support for temperature sensor in wsa 



WSA881x has temperature sensor which is used to calculate
initial thermal equilibrium temperature t0. Add support
to program thermal zone device and facilitate HAL
to query for t0 value.

Change-Id: Ie5127ea00b955d3f772c2e2bf2b0babfd7ee4c90
Signed-off-by: default avatarLaxminath Kasam <lkasam@codeaurora.org>
parent fd854d74

sound/soc/codecs/wsa881x-temp-sensor.c

0 → 100644
+138 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2015, The Linux Foundation. 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 version 2 and

 * only version 2 as published by the Free Software Foundation.

 *

 * 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/bitops.h>

#include <linux/kernel.h>

#include <linux/errno.h>

#include <linux/delay.h>

#include <linux/thermal.h>

#include <sound/soc.h>

#include "wsa881x-temp-sensor.h"



#define T1_TEMP -10

#define T2_TEMP 150

#define LOW_TEMP_THRESHOLD 5

#define HIGH_TEMP_THRESHOLD 45

#define WSA881X_OTP_REG_1	0x0081

#define WSA881X_OTP_REG_2	0x0082

#define WSA881X_OTP_REG_3	0x0083

#define WSA881X_OTP_REG_4	0x0084

#define WSA881X_TEMP_DOUT_MSB	0x000A

#define WSA881X_TEMP_DOUT_LSB	0x000B

#define TEMP_INVALID	0xFFFF



static void calculate_temp(long temp_val, int dmeas,

			struct snd_soc_codec *codec,

			int dig_base_addr)

{

	/* Tmeas = T1 + ((Dmeas - D1)/(D2 - D1))(T2 - T1) */

	int t1 = T1_TEMP;

	int t2 = T2_TEMP;

	int d1_lsb, d1_msb, d2_lsb, d2_msb;

	int d1, d2;



	d1_msb = snd_soc_read(codec, dig_base_addr + WSA881X_OTP_REG_1);

	d1_lsb = snd_soc_read(codec, dig_base_addr + WSA881X_OTP_REG_2);

	d2_msb = snd_soc_read(codec, dig_base_addr + WSA881X_OTP_REG_3);

	d2_lsb = snd_soc_read(codec, dig_base_addr + WSA881X_OTP_REG_4);



	d1 = ((d1_msb << 0x8) | d1_lsb) >> 0x6;

	d2 = ((d2_msb << 0x8) | d2_lsb) >> 0x6;



	if (d1 == d2) {

		temp_val = TEMP_INVALID;

		return;

	}

	temp_val = t1 + ((dmeas - d1)/(d2 - d1)) * (t2 - t1);

}



static int wsa881x_get_temp(struct thermal_zone_device *thermal,

			unsigned long *temp)

{

	struct wsa881x_tz_priv *pdata;

	struct snd_soc_codec *codec;

	int dmeas_cur_msb, dmeas_cur_lsb;

	int dmeas;

	int ret = 0;

	long temp_val;



	if (thermal->devdata) {

		pdata = thermal->devdata;

		if (pdata->codec) {

			codec = pdata->codec;

		} else {

			pr_err("%s: codec is NULL\n", __func__);

			return -EINVAL;

		}

	} else {

		pr_err("%s: pdata is NULL\n", __func__);

		return -EINVAL;

	}

	ret = pdata->wsa_resource_acquire(codec, true);

	if (ret) {

		pr_err("%s: wsa acquire failed: %d\n", __func__, ret);

		return ret;

	}

	dmeas_cur_msb =

		snd_soc_read(codec,

			pdata->ana_base + WSA881X_TEMP_DOUT_MSB);

	dmeas_cur_lsb =

		snd_soc_read(codec,

			pdata->ana_base + WSA881X_TEMP_DOUT_LSB);

	dmeas = ((dmeas_cur_msb << 0x8) | dmeas_cur_lsb) >> 0x6;

	pr_debug("%s: dmeas: %d\n", __func__, dmeas);

	calculate_temp(temp_val, dmeas, codec, pdata->dig_base);

	if (temp_val <= LOW_TEMP_THRESHOLD ||

			temp_val >= HIGH_TEMP_THRESHOLD) {

		ret = -EAGAIN;

		goto rel;

	}

	*temp = temp_val;

	pr_debug("%s: t0 measured: %ld\n", __func__, temp_val);

rel:

	ret = pdata->wsa_resource_acquire(codec, false);

	if (ret)

		pr_err("%s: wsa release failed: %d\n", __func__, ret);

	return ret;

}



static struct thermal_zone_device_ops wsa881x_thermal_ops = {

	.get_temp = wsa881x_get_temp,

};



int wsa881x_init_thermal(struct wsa881x_tz_priv *tz_pdata)

{

	struct thermal_zone_device *tz_dev;



	if (tz_pdata == NULL) {

		pr_err("%s: thermal pdata is NULL\n", __func__);

		return -EINVAL;

	}

	/* Register with the thermal zone */

	tz_dev = thermal_zone_device_register(tz_pdata->name,

				0, 0, tz_pdata,

				&wsa881x_thermal_ops, NULL, 0, 0);

	if (IS_ERR(tz_dev)) {

		pr_err("%s: thermal device register failed.\n", __func__);

		return -EINVAL;

	}

	tz_pdata->tz_dev = tz_dev;

	return 0;

}

EXPORT_SYMBOL(wsa881x_init_thermal);



void wsa881x_deinit_thermal(struct thermal_zone_device *tz_dev)

{

	if (tz_dev)

		thermal_zone_device_unregister(tz_dev);

}

EXPORT_SYMBOL(wsa881x_deinit_thermal);

sound/soc/codecs/wsa881x-temp-sensor.h

0 → 100644
+31 −0
Original line number Diff line number Diff line 
/* Copyright (c) 2015, The Linux Foundation. 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 version 2 and

 * only version 2 as published by the Free Software Foundation.

 *

 * 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.

 */

#ifndef WSA881X_TEMP_SENSOR_H

#define WSA881X_TEMP_SENSOR_H



#include <linux/thermal.h>

#include <sound/soc.h>



typedef int32_t (*wsa_rsrc_acquire)(struct snd_soc_codec *codec, bool enable);



struct wsa881x_tz_priv {

	struct thermal_zone_device *tz_dev;

	struct snd_soc_codec *codec;

	int dig_base;

	int ana_base;

	char name[80];

	wsa_rsrc_acquire wsa_resource_acquire;

};



int wsa881x_init_thermal(struct wsa881x_tz_priv *tz_pdata);

void wsa881x_deinit_thermal(struct thermal_zone_device *tz_dev);

#endif