qca-ssdk/src/hsl/phy/qca808x_led.c

/*
 * Copyright (c) 2020, The Linux Foundation. All rights reserved.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include "sw.h"
#include "hsl_phy.h"
#include "ssdk_plat.h"
#include "qca808x_phy.h"
#include "qca808x_led.h"

static sw_error_t
_qca808x_phy_led_active_set(a_uint32_t dev_id, a_uint32_t phy_id,
	led_ctrl_pattern_t *pattern)
{
	sw_error_t rv = SW_OK;
	a_uint16_t phy_data = 0;

	phy_data= qca808x_phy_mmd_read(dev_id, phy_id, QCA808X_PHY_MMD7_NUM,
			QCA808X_PHY_MMD7_LED_POLARITY_CTRL);
	PHY_RTN_ON_READ_ERROR(phy_data);
	if(pattern->map & BIT(LED_ACTIVE_HIGH))
	{
		phy_data |= QCA808X_PHY_MMD7_LED_POLARITY_MASK;
	}
	else
	{
		phy_data &= ~QCA808X_PHY_MMD7_LED_POLARITY_MASK;
	}
	rv = qca808x_phy_mmd_write(dev_id, phy_id, QCA808X_PHY_MMD7_NUM,
		QCA808X_PHY_MMD7_LED_POLARITY_CTRL, phy_data);

	return rv;
}

static sw_error_t
_qca808x_phy_led_active_get(a_uint32_t dev_id, a_uint32_t phy_id,
	led_ctrl_pattern_t *pattern)
{
	a_uint16_t phy_data = 0;

	phy_data = qca808x_phy_mmd_read(dev_id, phy_id, QCA808X_PHY_MMD7_NUM,
		QCA808X_PHY_MMD7_LED_POLARITY_CTRL);
	PHY_RTN_ON_READ_ERROR(phy_data);
	if(phy_data & QCA808X_PHY_MMD7_LED_POLARITY_MASK)
	{
		pattern->map |= BIT(LED_ACTIVE_HIGH);
	}

	return SW_OK;
}

static sw_error_t
_qca808x_phy_led_pattern_map_from_phy(a_uint32_t dev_id, a_uint32_t phy_id,
	led_ctrl_pattern_t *pattern, a_uint16_t *phy_data)
{
	if (qca808x_phy_2500caps(dev_id, phy_id) == A_TRUE)
	{
		if(*phy_data & QCA808X_PHY_LINK_2500M_LIGHT_EN)
		{
			pattern->map |= BIT(LINK_2500M_LIGHT_EN);
		}
	}
	if(*phy_data & QCA808X_PHY_LINK_1000M_LIGHT_EN)
	{
		pattern->map |= BIT(LINK_1000M_LIGHT_EN);
	}
	if(*phy_data & QCA808X_PHY_LINK_100M_LIGHT_EN)
	{
		pattern->map |= BIT(LINK_100M_LIGHT_EN);
	}
	if(*phy_data & QCA808X_PHY_LINK_10M_LIGHT_EN)
	{
		pattern->map |= BIT(LINK_10M_LIGHT_EN);
	}
	if (*phy_data & QCA808X_PHY_RX_TRAFFIC_BLINK_EN)
	{
		pattern->map |= BIT(RX_TRAFFIC_BLINK_EN);
	}
	if (*phy_data & QCA808X_PHY_TX_TRAFFIC_BLINK_EN)
	{
		pattern->map |= BIT(TX_TRAFFIC_BLINK_EN);
	}

	return SW_OK;
}

static sw_error_t
_qca808x_phy_led_pattern_map_to_phy(a_uint32_t dev_id, a_uint32_t phy_id,
	led_ctrl_pattern_t *pattern, a_uint32_t *led_map)
{
	if (qca808x_phy_2500caps(dev_id, phy_id) == A_TRUE)
	{
		if (pattern->map & BIT(LINK_2500M_LIGHT_EN))
		{
			*led_map |=  QCA808X_PHY_LINK_2500M_LIGHT_EN;
		}
	}
	if (pattern->map & BIT(LINK_1000M_LIGHT_EN))
	{
		*led_map |=  QCA808X_PHY_LINK_1000M_LIGHT_EN;
	}
	if (pattern->map & BIT(LINK_100M_LIGHT_EN))
	{
		*led_map |=  QCA808X_PHY_LINK_100M_LIGHT_EN;
	}
	if (pattern->map & BIT(LINK_10M_LIGHT_EN))
	{
		*led_map |=  QCA808X_PHY_LINK_10M_LIGHT_EN;
	}
	if (pattern->map & BIT(RX_TRAFFIC_BLINK_EN))
	{
		*led_map |=  QCA808X_PHY_RX_TRAFFIC_BLINK_EN;
	}
	if (pattern->map & BIT(TX_TRAFFIC_BLINK_EN))
	{
		*led_map |=  QCA808X_PHY_TX_TRAFFIC_BLINK_EN;
	}

	return SW_OK;
}

/******************************************************************************
*
* qca808x_phy_led_ctrl_pattern_set
*
*/
sw_error_t
qca808x_phy_led_ctrl_pattern_set(a_uint32_t dev_id, a_uint32_t phy_id,
	led_ctrl_pattern_t *pattern)
{
	sw_error_t rv = SW_OK;
	a_uint32_t source_id = 0;

	if(LED_PATTERN_MAP_EN != pattern->mode)
	{
		SSDK_ERROR("led mode %d is not supported\n", pattern->mode);
		return SW_NOT_SUPPORTED;
	}
	for(source_id = QCA808X_PHY_LED_SOURCE0; source_id <= QCA808X_PHY_LED_SOURCE2;
		source_id++)
	{
		/*three source use the same pattern*/
		rv = qca808x_phy_led_ctrl_source_set (dev_id, phy_id, source_id, pattern);
		SW_RTN_ON_ERROR(rv);
	}

	return rv;
}

/******************************************************************************
*
* qca808x_phy_led_ctrl_pattern_get
*
*/
sw_error_t
qca808x_phy_led_ctrl_pattern_get(a_uint32_t dev_id, a_uint32_t phy_id,
	led_ctrl_pattern_t *pattern)
{
	sw_error_t rv = SW_OK;

	/*three source use the same pattern*/
	rv = qca808x_phy_led_ctrl_source_get(dev_id, phy_id, QCA808X_PHY_LED_SOURCE0,
		pattern);

	return rv;
}

/******************************************************************************
*
* qca808x_phy_led_source_pattern_set
*
*/
sw_error_t
qca808x_phy_led_ctrl_source_set(a_uint32_t dev_id, a_uint32_t phy_id,
	a_uint32_t source_id, led_ctrl_pattern_t *pattern)
{
	sw_error_t rv = SW_OK;
	a_uint32_t led_map = 0;
	a_uint16_t led_mmd_addr = 0;

	if(LED_PATTERN_MAP_EN != pattern->mode)
	{
		return SW_NOT_SUPPORTED;
	}

	rv = _qca808x_phy_led_active_set(dev_id,  phy_id, pattern);
	SW_RTN_ON_ERROR(rv);
	rv = _qca808x_phy_led_pattern_map_to_phy(dev_id, phy_id, pattern, &led_map);
	SW_RTN_ON_ERROR(rv);
	switch(source_id)
	{
		case QCA808X_PHY_LED_SOURCE0:
			led_mmd_addr = QCA808X_PHY_MMD7_LED0_CTRL;
			break;
		case QCA808X_PHY_LED_SOURCE1:
			led_mmd_addr = QCA808X_PHY_MMD7_LED1_CTRL;
			break;
		case QCA808X_PHY_LED_SOURCE2:
			led_mmd_addr = QCA808X_PHY_MMD7_LED2_CTRL;
			break;
		default:
			SSDK_ERROR("source %d is not support\n", source_id);
			break;
	}
	rv = qca808x_phy_mmd_write(dev_id, phy_id, QCA808X_PHY_MMD7_NUM,
		led_mmd_addr, led_map);

	return rv;
}
/******************************************************************************
*
* qca808x_phy_led_source_pattern_get
*
*/
sw_error_t
qca808x_phy_led_ctrl_source_get(a_uint32_t dev_id, a_uint32_t phy_id,
	a_uint32_t source_id, led_ctrl_pattern_t *pattern)
{
	sw_error_t rv = SW_OK;
	a_uint16_t phy_data = 0, led_mmd_addr = 0;

	pattern->map = 0;
	pattern->mode = LED_PATTERN_MAP_EN;
	rv = _qca808x_phy_led_active_get(dev_id, phy_id, pattern);
	SW_RTN_ON_ERROR(rv);
	switch(source_id)
	{
		case QCA808X_PHY_LED_SOURCE0:
			led_mmd_addr = QCA808X_PHY_MMD7_LED0_CTRL;
			break;
		case QCA808X_PHY_LED_SOURCE1:
			led_mmd_addr = QCA808X_PHY_MMD7_LED1_CTRL;
			break;
		case QCA808X_PHY_LED_SOURCE2:
			led_mmd_addr = QCA808X_PHY_MMD7_LED2_CTRL;
			break;
		default:
			SSDK_ERROR("source %d is not support\n", source_id);
			break;
	}
	phy_data = qca808x_phy_mmd_read(dev_id, phy_id, QCA808X_PHY_MMD7_NUM,
		led_mmd_addr);
	PHY_RTN_ON_READ_ERROR(phy_data);
	rv = _qca808x_phy_led_pattern_map_from_phy(dev_id, phy_id, pattern,
		&phy_data);

	return rv;
}

void qca808x_phy_led_api_ops_init(hsl_phy_ops_t *qca808x_phy_led_api_ops)
{
	if (!qca808x_phy_led_api_ops) {
		return;
	}
	qca808x_phy_led_api_ops->phy_led_ctrl_pattern_get = qca808x_phy_led_ctrl_pattern_get;
	qca808x_phy_led_api_ops->phy_led_ctrl_pattern_set = qca808x_phy_led_ctrl_pattern_set;
	qca808x_phy_led_api_ops->phy_led_ctrl_source_set = qca808x_phy_led_ctrl_source_set;

	return;
}