Quelle  rt-sdw-common.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
//
// rt-sdw-common.c
//
// Copyright(c) 2024 Realtek Semiconductor Corp.
//

/*
 * This file defines common functions used with Realtek soundwire codecs.
 */

#include <linux/module.h>
#include <linux/regmap.h>
#include <linux/bitops.h>
#include <linux/soundwire/sdw_registers.h>
#include <sound/jack.h>

#include "rt-sdw-common.h"

/**
 * rt_sdca_index_write - Write a value to Realtek defined register.
 *
 * @map: map for setting.
 * @nid: Realtek-defined ID.
 * @reg: register.
 * @value: value.
 *
 * A value of zero will be returned on success, a negative errno will
 * be returned in error cases.
 */
int rt_sdca_index_write(struct regmap *map, unsigned int nid,
 unsigned int reg, unsigned int value)
{
 unsigned int addr = (nid << 20) | reg;
 int ret;

 ret = regmap_write(map, addr, value);
 if (ret < 0)
  pr_err("Failed to set value: %06x <= %04x ret=%d\n",
   addr, value, ret);

 return ret;
}
EXPORT_SYMBOL_GPL(rt_sdca_index_write);

/**
 * rt_sdca_index_read - Read value from Realtek defined register.
 *
 * @map: map for setting.
 * @nid: Realtek-defined ID.
 * @reg: register.
 * @value: value.
 *
 * A value of zero will be returned on success, a negative errno will
 * be returned in error cases.
 */
int rt_sdca_index_read(struct regmap *map, unsigned int nid,
 unsigned int reg, unsigned int *value)
{
 unsigned int addr = (nid << 20) | reg;
 int ret;

 ret = regmap_read(map, addr, value);
 if (ret < 0)
  pr_err("Failed to get value: %06x => %04x ret=%d\n",
   addr, *value, ret);

 return ret;
}
EXPORT_SYMBOL_GPL(rt_sdca_index_read);

/**
 * rt_sdca_index_update_bits - Update value on Realtek defined register.
 *
 * @map: map for setting.
 * @nid: Realtek-defined ID.
 * @reg: register.
 * @mask: Bitmask to change
 * @val: New value for bitmask
 *
 * A value of zero will be returned on success, a negative errno will
 * be returned in error cases.
 */

int rt_sdca_index_update_bits(struct regmap *map,
 unsigned int nid, unsigned int reg, unsigned int mask, unsigned int val)
{
 unsigned int tmp;
 int ret;

 ret = rt_sdca_index_read(map, nid, reg, &tmp);
 if (ret < 0)
  return ret;

 set_mask_bits(&tmp, mask, val);
 return rt_sdca_index_write(map, nid, reg, tmp);
}
EXPORT_SYMBOL_GPL(rt_sdca_index_update_bits);

/**
 * rt_sdca_btn_type - Decision of button type.
 *
 * @buffer: UMP message buffer.
 *
 * A button type will be returned regarding to buffer,
 * it returns zero if buffer cannot be recognized.
 */
int rt_sdca_btn_type(unsigned char *buffer)
{
 u8 btn_type = 0;
 int ret = 0;

 btn_type |= buffer[0] & 0xf;
 btn_type |= (buffer[0] >> 4) & 0xf;
 btn_type |= buffer[1] & 0xf;
 btn_type |= (buffer[1] >> 4) & 0xf;

 if (btn_type & BIT(0))
  ret |= SND_JACK_BTN_2;
 if (btn_type & BIT(1))
  ret |= SND_JACK_BTN_3;
 if (btn_type & BIT(2))
  ret |= SND_JACK_BTN_0;
 if (btn_type & BIT(3))
  ret |= SND_JACK_BTN_1;

 return ret;
}
EXPORT_SYMBOL_GPL(rt_sdca_btn_type);

/**
 * rt_sdca_headset_detect - Headset jack type detection.
 *
 * @map: map for setting.
 * @entity_id: SDCA entity ID.
 *
 * A headset jack type will be returned, a negative errno will
 * be returned in error cases.
 */
int rt_sdca_headset_detect(struct regmap *map, unsigned int entity_id)
{
 unsigned int det_mode, jack_type;
 int ret;

 /* get detected_mode */
 ret = regmap_read(map, SDW_SDCA_CTL(SDCA_NUM_JACK_CODEC, entity_id,
   RT_SDCA_CTL_DETECTED_MODE, 0), &det_mode);

 if (ret < 0)
  goto io_error;

 switch (det_mode) {
 case 0x03:
  jack_type = SND_JACK_HEADPHONE;
  break;
 case 0x05:
  jack_type = SND_JACK_HEADSET;
  break;
 default:
  jack_type = 0;
  break;
 }

 /* write selected_mode */
 if (det_mode) {
  ret = regmap_write(map, SDW_SDCA_CTL(SDCA_NUM_JACK_CODEC, entity_id,
    RT_SDCA_CTL_SELECTED_MODE, 0), det_mode);
  if (ret < 0)
   goto io_error;
 }

 return jack_type;

io_error:
 pr_err_ratelimited("IO error in %s, ret %d\n", __func__, ret);
 return ret;
}
EXPORT_SYMBOL_GPL(rt_sdca_headset_detect);

/**
 * rt_sdca_button_detect - Read UMP message and decide button type.
 *
 * @map: map for setting.
 * @entity_id: SDCA entity ID.
 * @hid_buf_addr: HID buffer address.
 * @hid_id: Report ID for HID.
 *
 * A button type will be returned regarding to buffer,
 * it returns zero if buffer cannot be recognized.
 */
int rt_sdca_button_detect(struct regmap *map, unsigned int entity_id,
 unsigned int hid_buf_addr, unsigned int hid_id)
{
 unsigned int btn_type = 0, offset, idx, val, owner;
 unsigned char buf[3];
 int ret;

 /* get current UMP message owner */
 ret = regmap_read(map, SDW_SDCA_CTL(SDCA_NUM_HID, entity_id,
   RT_SDCA_CTL_HIDTX_CURRENT_OWNER, 0), &owner);
 if (ret < 0)
  return 0;

 /* if owner is device then there is no button event from device */
 if (owner == 1)
  return 0;

 /* read UMP message offset */
 ret = regmap_read(map, SDW_SDCA_CTL(SDCA_NUM_HID, entity_id,
   RT_SDCA_CTL_HIDTX_MESSAGE_OFFSET, 0), &offset);
 if (ret < 0)
  goto _end_btn_det_;

 for (idx = 0; idx < sizeof(buf); idx++) {
  ret = regmap_read(map, hid_buf_addr + offset + idx, &val);
  if (ret < 0)
   goto _end_btn_det_;
  buf[idx] = val & 0xff;
 }
 /* Report ID for HID */
 if (buf[0] == hid_id)
  btn_type = rt_sdca_btn_type(&buf[1]);

_end_btn_det_:
 /* Host is owner, so set back to device */
 if (owner == 0)
  /* set owner to device */
  regmap_write(map,
   SDW_SDCA_CTL(SDCA_NUM_HID, entity_id,
    RT_SDCA_CTL_HIDTX_CURRENT_OWNER, 0), 0x01);

 return btn_type;
}
EXPORT_SYMBOL_GPL(rt_sdca_button_detect);

MODULE_DESCRIPTION("Realtek soundwire common functions");
MODULE_AUTHOR("jack yu ");
MODULE_LICENSE("GPL");