162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * The Huawei Cache Coherence System (HCCS) is a multi-chip interconnection 462306a36Sopenharmony_ci * bus protocol. 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * Copyright (c) 2023 Hisilicon Limited. 762306a36Sopenharmony_ci * Author: Huisong Li <lihuisong@huawei.com> 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * HCCS driver for Kunpeng SoC provides the following features: 1062306a36Sopenharmony_ci * - Retrieve the following information about each port: 1162306a36Sopenharmony_ci * - port type 1262306a36Sopenharmony_ci * - lane mode 1362306a36Sopenharmony_ci * - enable 1462306a36Sopenharmony_ci * - current lane mode 1562306a36Sopenharmony_ci * - link finite state machine 1662306a36Sopenharmony_ci * - lane mask 1762306a36Sopenharmony_ci * - CRC error count 1862306a36Sopenharmony_ci * 1962306a36Sopenharmony_ci * - Retrieve the following information about all the ports on the chip or 2062306a36Sopenharmony_ci * the die: 2162306a36Sopenharmony_ci * - if all enabled ports are in linked 2262306a36Sopenharmony_ci * - if all linked ports are in full lane 2362306a36Sopenharmony_ci * - CRC error count sum 2462306a36Sopenharmony_ci */ 2562306a36Sopenharmony_ci#include <linux/acpi.h> 2662306a36Sopenharmony_ci#include <linux/iopoll.h> 2762306a36Sopenharmony_ci#include <linux/platform_device.h> 2862306a36Sopenharmony_ci#include <linux/sysfs.h> 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci#include <acpi/pcc.h> 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci#include "kunpeng_hccs.h" 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci/* PCC defines */ 3562306a36Sopenharmony_ci#define HCCS_PCC_SIGNATURE_MASK 0x50434300 3662306a36Sopenharmony_ci#define HCCS_PCC_STATUS_CMD_COMPLETE BIT(0) 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci/* 3962306a36Sopenharmony_ci * Arbitrary retries in case the remote processor is slow to respond 4062306a36Sopenharmony_ci * to PCC commands 4162306a36Sopenharmony_ci */ 4262306a36Sopenharmony_ci#define HCCS_PCC_CMD_WAIT_RETRIES_NUM 500ULL 4362306a36Sopenharmony_ci#define HCCS_POLL_STATUS_TIME_INTERVAL_US 3 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_cistatic struct hccs_port_info *kobj_to_port_info(struct kobject *k) 4662306a36Sopenharmony_ci{ 4762306a36Sopenharmony_ci return container_of(k, struct hccs_port_info, kobj); 4862306a36Sopenharmony_ci} 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_cistatic struct hccs_die_info *kobj_to_die_info(struct kobject *k) 5162306a36Sopenharmony_ci{ 5262306a36Sopenharmony_ci return container_of(k, struct hccs_die_info, kobj); 5362306a36Sopenharmony_ci} 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_cistatic struct hccs_chip_info *kobj_to_chip_info(struct kobject *k) 5662306a36Sopenharmony_ci{ 5762306a36Sopenharmony_ci return container_of(k, struct hccs_chip_info, kobj); 5862306a36Sopenharmony_ci} 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_cistruct hccs_register_ctx { 6162306a36Sopenharmony_ci struct device *dev; 6262306a36Sopenharmony_ci u8 chan_id; 6362306a36Sopenharmony_ci int err; 6462306a36Sopenharmony_ci}; 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_cistatic acpi_status hccs_get_register_cb(struct acpi_resource *ares, 6762306a36Sopenharmony_ci void *context) 6862306a36Sopenharmony_ci{ 6962306a36Sopenharmony_ci struct acpi_resource_generic_register *reg; 7062306a36Sopenharmony_ci struct hccs_register_ctx *ctx = context; 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_ci if (ares->type != ACPI_RESOURCE_TYPE_GENERIC_REGISTER) 7362306a36Sopenharmony_ci return AE_OK; 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_ci reg = &ares->data.generic_reg; 7662306a36Sopenharmony_ci if (reg->space_id != ACPI_ADR_SPACE_PLATFORM_COMM) { 7762306a36Sopenharmony_ci dev_err(ctx->dev, "Bad register resource.\n"); 7862306a36Sopenharmony_ci ctx->err = -EINVAL; 7962306a36Sopenharmony_ci return AE_ERROR; 8062306a36Sopenharmony_ci } 8162306a36Sopenharmony_ci ctx->chan_id = reg->access_size; 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_ci return AE_OK; 8462306a36Sopenharmony_ci} 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_cistatic int hccs_get_pcc_chan_id(struct hccs_dev *hdev) 8762306a36Sopenharmony_ci{ 8862306a36Sopenharmony_ci acpi_handle handle = ACPI_HANDLE(hdev->dev); 8962306a36Sopenharmony_ci struct hccs_register_ctx ctx = {0}; 9062306a36Sopenharmony_ci acpi_status status; 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci if (!acpi_has_method(handle, METHOD_NAME__CRS)) 9362306a36Sopenharmony_ci return -ENODEV; 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ci ctx.dev = hdev->dev; 9662306a36Sopenharmony_ci status = acpi_walk_resources(handle, METHOD_NAME__CRS, 9762306a36Sopenharmony_ci hccs_get_register_cb, &ctx); 9862306a36Sopenharmony_ci if (ACPI_FAILURE(status)) 9962306a36Sopenharmony_ci return ctx.err; 10062306a36Sopenharmony_ci hdev->chan_id = ctx.chan_id; 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_ci return 0; 10362306a36Sopenharmony_ci} 10462306a36Sopenharmony_ci 10562306a36Sopenharmony_cistatic void hccs_chan_tx_done(struct mbox_client *cl, void *msg, int ret) 10662306a36Sopenharmony_ci{ 10762306a36Sopenharmony_ci if (ret < 0) 10862306a36Sopenharmony_ci pr_debug("TX did not complete: CMD sent:0x%x, ret:%d\n", 10962306a36Sopenharmony_ci *(u8 *)msg, ret); 11062306a36Sopenharmony_ci else 11162306a36Sopenharmony_ci pr_debug("TX completed. CMD sent:0x%x, ret:%d\n", 11262306a36Sopenharmony_ci *(u8 *)msg, ret); 11362306a36Sopenharmony_ci} 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_cistatic void hccs_unregister_pcc_channel(struct hccs_dev *hdev) 11662306a36Sopenharmony_ci{ 11762306a36Sopenharmony_ci struct hccs_mbox_client_info *cl_info = &hdev->cl_info; 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci if (cl_info->pcc_comm_addr) 12062306a36Sopenharmony_ci iounmap(cl_info->pcc_comm_addr); 12162306a36Sopenharmony_ci pcc_mbox_free_channel(hdev->cl_info.pcc_chan); 12262306a36Sopenharmony_ci} 12362306a36Sopenharmony_ci 12462306a36Sopenharmony_cistatic int hccs_register_pcc_channel(struct hccs_dev *hdev) 12562306a36Sopenharmony_ci{ 12662306a36Sopenharmony_ci struct hccs_mbox_client_info *cl_info = &hdev->cl_info; 12762306a36Sopenharmony_ci struct mbox_client *cl = &cl_info->client; 12862306a36Sopenharmony_ci struct pcc_mbox_chan *pcc_chan; 12962306a36Sopenharmony_ci struct device *dev = hdev->dev; 13062306a36Sopenharmony_ci int rc; 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_ci cl->dev = dev; 13362306a36Sopenharmony_ci cl->tx_block = false; 13462306a36Sopenharmony_ci cl->knows_txdone = true; 13562306a36Sopenharmony_ci cl->tx_done = hccs_chan_tx_done; 13662306a36Sopenharmony_ci pcc_chan = pcc_mbox_request_channel(cl, hdev->chan_id); 13762306a36Sopenharmony_ci if (IS_ERR(pcc_chan)) { 13862306a36Sopenharmony_ci dev_err(dev, "PPC channel request failed.\n"); 13962306a36Sopenharmony_ci rc = -ENODEV; 14062306a36Sopenharmony_ci goto out; 14162306a36Sopenharmony_ci } 14262306a36Sopenharmony_ci cl_info->pcc_chan = pcc_chan; 14362306a36Sopenharmony_ci cl_info->mbox_chan = pcc_chan->mchan; 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_ci /* 14662306a36Sopenharmony_ci * pcc_chan->latency is just a nominal value. In reality the remote 14762306a36Sopenharmony_ci * processor could be much slower to reply. So add an arbitrary amount 14862306a36Sopenharmony_ci * of wait on top of nominal. 14962306a36Sopenharmony_ci */ 15062306a36Sopenharmony_ci cl_info->deadline_us = 15162306a36Sopenharmony_ci HCCS_PCC_CMD_WAIT_RETRIES_NUM * pcc_chan->latency; 15262306a36Sopenharmony_ci if (cl_info->mbox_chan->mbox->txdone_irq) { 15362306a36Sopenharmony_ci dev_err(dev, "PCC IRQ in PCCT is enabled.\n"); 15462306a36Sopenharmony_ci rc = -EINVAL; 15562306a36Sopenharmony_ci goto err_mbx_channel_free; 15662306a36Sopenharmony_ci } 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci if (pcc_chan->shmem_base_addr) { 15962306a36Sopenharmony_ci cl_info->pcc_comm_addr = ioremap(pcc_chan->shmem_base_addr, 16062306a36Sopenharmony_ci pcc_chan->shmem_size); 16162306a36Sopenharmony_ci if (!cl_info->pcc_comm_addr) { 16262306a36Sopenharmony_ci dev_err(dev, "Failed to ioremap PCC communication region for channel-%d.\n", 16362306a36Sopenharmony_ci hdev->chan_id); 16462306a36Sopenharmony_ci rc = -ENOMEM; 16562306a36Sopenharmony_ci goto err_mbx_channel_free; 16662306a36Sopenharmony_ci } 16762306a36Sopenharmony_ci } 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_ci return 0; 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_cierr_mbx_channel_free: 17262306a36Sopenharmony_ci pcc_mbox_free_channel(cl_info->pcc_chan); 17362306a36Sopenharmony_ciout: 17462306a36Sopenharmony_ci return rc; 17562306a36Sopenharmony_ci} 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_cistatic int hccs_check_chan_cmd_complete(struct hccs_dev *hdev) 17862306a36Sopenharmony_ci{ 17962306a36Sopenharmony_ci struct hccs_mbox_client_info *cl_info = &hdev->cl_info; 18062306a36Sopenharmony_ci struct acpi_pcct_shared_memory __iomem *comm_base = 18162306a36Sopenharmony_ci cl_info->pcc_comm_addr; 18262306a36Sopenharmony_ci u16 status; 18362306a36Sopenharmony_ci int ret; 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci /* 18662306a36Sopenharmony_ci * Poll PCC status register every 3us(delay_us) for maximum of 18762306a36Sopenharmony_ci * deadline_us(timeout_us) until PCC command complete bit is set(cond) 18862306a36Sopenharmony_ci */ 18962306a36Sopenharmony_ci ret = readw_poll_timeout(&comm_base->status, status, 19062306a36Sopenharmony_ci status & HCCS_PCC_STATUS_CMD_COMPLETE, 19162306a36Sopenharmony_ci HCCS_POLL_STATUS_TIME_INTERVAL_US, 19262306a36Sopenharmony_ci cl_info->deadline_us); 19362306a36Sopenharmony_ci if (unlikely(ret)) 19462306a36Sopenharmony_ci dev_err(hdev->dev, "poll PCC status failed, ret = %d.\n", ret); 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci return ret; 19762306a36Sopenharmony_ci} 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_cistatic int hccs_pcc_cmd_send(struct hccs_dev *hdev, u8 cmd, 20062306a36Sopenharmony_ci struct hccs_desc *desc) 20162306a36Sopenharmony_ci{ 20262306a36Sopenharmony_ci struct hccs_mbox_client_info *cl_info = &hdev->cl_info; 20362306a36Sopenharmony_ci void __iomem *comm_space = cl_info->pcc_comm_addr + 20462306a36Sopenharmony_ci sizeof(struct acpi_pcct_shared_memory); 20562306a36Sopenharmony_ci struct hccs_fw_inner_head *fw_inner_head; 20662306a36Sopenharmony_ci struct acpi_pcct_shared_memory tmp = {0}; 20762306a36Sopenharmony_ci u16 comm_space_size; 20862306a36Sopenharmony_ci int ret; 20962306a36Sopenharmony_ci 21062306a36Sopenharmony_ci /* Write signature for this subspace */ 21162306a36Sopenharmony_ci tmp.signature = HCCS_PCC_SIGNATURE_MASK | hdev->chan_id; 21262306a36Sopenharmony_ci /* Write to the shared command region */ 21362306a36Sopenharmony_ci tmp.command = cmd; 21462306a36Sopenharmony_ci /* Clear cmd complete bit */ 21562306a36Sopenharmony_ci tmp.status = 0; 21662306a36Sopenharmony_ci memcpy_toio(cl_info->pcc_comm_addr, (void *)&tmp, 21762306a36Sopenharmony_ci sizeof(struct acpi_pcct_shared_memory)); 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci /* Copy the message to the PCC comm space */ 22062306a36Sopenharmony_ci comm_space_size = HCCS_PCC_SHARE_MEM_BYTES - 22162306a36Sopenharmony_ci sizeof(struct acpi_pcct_shared_memory); 22262306a36Sopenharmony_ci memcpy_toio(comm_space, (void *)desc, comm_space_size); 22362306a36Sopenharmony_ci 22462306a36Sopenharmony_ci /* Ring doorbell */ 22562306a36Sopenharmony_ci ret = mbox_send_message(cl_info->mbox_chan, &cmd); 22662306a36Sopenharmony_ci if (ret < 0) { 22762306a36Sopenharmony_ci dev_err(hdev->dev, "Send PCC mbox message failed, ret = %d.\n", 22862306a36Sopenharmony_ci ret); 22962306a36Sopenharmony_ci goto end; 23062306a36Sopenharmony_ci } 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci /* Wait for completion */ 23362306a36Sopenharmony_ci ret = hccs_check_chan_cmd_complete(hdev); 23462306a36Sopenharmony_ci if (ret) 23562306a36Sopenharmony_ci goto end; 23662306a36Sopenharmony_ci 23762306a36Sopenharmony_ci /* Copy response data */ 23862306a36Sopenharmony_ci memcpy_fromio((void *)desc, comm_space, comm_space_size); 23962306a36Sopenharmony_ci fw_inner_head = &desc->rsp.fw_inner_head; 24062306a36Sopenharmony_ci if (fw_inner_head->retStatus) { 24162306a36Sopenharmony_ci dev_err(hdev->dev, "Execute PCC command failed, error code = %u.\n", 24262306a36Sopenharmony_ci fw_inner_head->retStatus); 24362306a36Sopenharmony_ci ret = -EIO; 24462306a36Sopenharmony_ci } 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ciend: 24762306a36Sopenharmony_ci mbox_client_txdone(cl_info->mbox_chan, ret); 24862306a36Sopenharmony_ci return ret; 24962306a36Sopenharmony_ci} 25062306a36Sopenharmony_ci 25162306a36Sopenharmony_cistatic void hccs_init_req_desc(struct hccs_desc *desc) 25262306a36Sopenharmony_ci{ 25362306a36Sopenharmony_ci struct hccs_req_desc *req = &desc->req; 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_ci memset(desc, 0, sizeof(*desc)); 25662306a36Sopenharmony_ci req->req_head.module_code = HCCS_SERDES_MODULE_CODE; 25762306a36Sopenharmony_ci} 25862306a36Sopenharmony_ci 25962306a36Sopenharmony_cistatic int hccs_get_dev_caps(struct hccs_dev *hdev) 26062306a36Sopenharmony_ci{ 26162306a36Sopenharmony_ci struct hccs_desc desc; 26262306a36Sopenharmony_ci int ret; 26362306a36Sopenharmony_ci 26462306a36Sopenharmony_ci hccs_init_req_desc(&desc); 26562306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_DEV_CAP, &desc); 26662306a36Sopenharmony_ci if (ret) { 26762306a36Sopenharmony_ci dev_err(hdev->dev, "Get device capabilities failed, ret = %d.\n", 26862306a36Sopenharmony_ci ret); 26962306a36Sopenharmony_ci return ret; 27062306a36Sopenharmony_ci } 27162306a36Sopenharmony_ci memcpy(&hdev->caps, desc.rsp.data, sizeof(hdev->caps)); 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_ci return 0; 27462306a36Sopenharmony_ci} 27562306a36Sopenharmony_ci 27662306a36Sopenharmony_cistatic int hccs_query_chip_num_on_platform(struct hccs_dev *hdev) 27762306a36Sopenharmony_ci{ 27862306a36Sopenharmony_ci struct hccs_desc desc; 27962306a36Sopenharmony_ci int ret; 28062306a36Sopenharmony_ci 28162306a36Sopenharmony_ci hccs_init_req_desc(&desc); 28262306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_CHIP_NUM, &desc); 28362306a36Sopenharmony_ci if (ret) { 28462306a36Sopenharmony_ci dev_err(hdev->dev, "query system chip number failed, ret = %d.\n", 28562306a36Sopenharmony_ci ret); 28662306a36Sopenharmony_ci return ret; 28762306a36Sopenharmony_ci } 28862306a36Sopenharmony_ci 28962306a36Sopenharmony_ci hdev->chip_num = *((u8 *)&desc.rsp.data); 29062306a36Sopenharmony_ci if (!hdev->chip_num) { 29162306a36Sopenharmony_ci dev_err(hdev->dev, "chip num obtained from firmware is zero.\n"); 29262306a36Sopenharmony_ci return -EINVAL; 29362306a36Sopenharmony_ci } 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci return 0; 29662306a36Sopenharmony_ci} 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_cistatic int hccs_get_chip_info(struct hccs_dev *hdev, 29962306a36Sopenharmony_ci struct hccs_chip_info *chip) 30062306a36Sopenharmony_ci{ 30162306a36Sopenharmony_ci struct hccs_die_num_req_param *req_param; 30262306a36Sopenharmony_ci struct hccs_desc desc; 30362306a36Sopenharmony_ci int ret; 30462306a36Sopenharmony_ci 30562306a36Sopenharmony_ci hccs_init_req_desc(&desc); 30662306a36Sopenharmony_ci req_param = (struct hccs_die_num_req_param *)desc.req.data; 30762306a36Sopenharmony_ci req_param->chip_id = chip->chip_id; 30862306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_DIE_NUM, &desc); 30962306a36Sopenharmony_ci if (ret) 31062306a36Sopenharmony_ci return ret; 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_ci chip->die_num = *((u8 *)&desc.rsp.data); 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci return 0; 31562306a36Sopenharmony_ci} 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_cistatic int hccs_query_chip_info_on_platform(struct hccs_dev *hdev) 31862306a36Sopenharmony_ci{ 31962306a36Sopenharmony_ci struct hccs_chip_info *chip; 32062306a36Sopenharmony_ci int ret; 32162306a36Sopenharmony_ci u8 idx; 32262306a36Sopenharmony_ci 32362306a36Sopenharmony_ci ret = hccs_query_chip_num_on_platform(hdev); 32462306a36Sopenharmony_ci if (ret) { 32562306a36Sopenharmony_ci dev_err(hdev->dev, "query chip number on platform failed, ret = %d.\n", 32662306a36Sopenharmony_ci ret); 32762306a36Sopenharmony_ci return ret; 32862306a36Sopenharmony_ci } 32962306a36Sopenharmony_ci 33062306a36Sopenharmony_ci hdev->chips = devm_kzalloc(hdev->dev, 33162306a36Sopenharmony_ci hdev->chip_num * sizeof(struct hccs_chip_info), 33262306a36Sopenharmony_ci GFP_KERNEL); 33362306a36Sopenharmony_ci if (!hdev->chips) { 33462306a36Sopenharmony_ci dev_err(hdev->dev, "allocate all chips memory failed.\n"); 33562306a36Sopenharmony_ci return -ENOMEM; 33662306a36Sopenharmony_ci } 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_ci for (idx = 0; idx < hdev->chip_num; idx++) { 33962306a36Sopenharmony_ci chip = &hdev->chips[idx]; 34062306a36Sopenharmony_ci chip->chip_id = idx; 34162306a36Sopenharmony_ci ret = hccs_get_chip_info(hdev, chip); 34262306a36Sopenharmony_ci if (ret) { 34362306a36Sopenharmony_ci dev_err(hdev->dev, "get chip%u info failed, ret = %d.\n", 34462306a36Sopenharmony_ci idx, ret); 34562306a36Sopenharmony_ci return ret; 34662306a36Sopenharmony_ci } 34762306a36Sopenharmony_ci chip->hdev = hdev; 34862306a36Sopenharmony_ci } 34962306a36Sopenharmony_ci 35062306a36Sopenharmony_ci return 0; 35162306a36Sopenharmony_ci} 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_cistatic int hccs_query_die_info_on_chip(struct hccs_dev *hdev, u8 chip_id, 35462306a36Sopenharmony_ci u8 die_idx, struct hccs_die_info *die) 35562306a36Sopenharmony_ci{ 35662306a36Sopenharmony_ci struct hccs_die_info_req_param *req_param; 35762306a36Sopenharmony_ci struct hccs_die_info_rsp_data *rsp_data; 35862306a36Sopenharmony_ci struct hccs_desc desc; 35962306a36Sopenharmony_ci int ret; 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci hccs_init_req_desc(&desc); 36262306a36Sopenharmony_ci req_param = (struct hccs_die_info_req_param *)desc.req.data; 36362306a36Sopenharmony_ci req_param->chip_id = chip_id; 36462306a36Sopenharmony_ci req_param->die_idx = die_idx; 36562306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_DIE_INFO, &desc); 36662306a36Sopenharmony_ci if (ret) 36762306a36Sopenharmony_ci return ret; 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci rsp_data = (struct hccs_die_info_rsp_data *)desc.rsp.data; 37062306a36Sopenharmony_ci die->die_id = rsp_data->die_id; 37162306a36Sopenharmony_ci die->port_num = rsp_data->port_num; 37262306a36Sopenharmony_ci die->min_port_id = rsp_data->min_port_id; 37362306a36Sopenharmony_ci die->max_port_id = rsp_data->max_port_id; 37462306a36Sopenharmony_ci if (die->min_port_id > die->max_port_id) { 37562306a36Sopenharmony_ci dev_err(hdev->dev, "min port id(%u) > max port id(%u) on die_idx(%u).\n", 37662306a36Sopenharmony_ci die->min_port_id, die->max_port_id, die_idx); 37762306a36Sopenharmony_ci return -EINVAL; 37862306a36Sopenharmony_ci } 37962306a36Sopenharmony_ci if (die->max_port_id > HCCS_DIE_MAX_PORT_ID) { 38062306a36Sopenharmony_ci dev_err(hdev->dev, "max port id(%u) on die_idx(%u) is too big.\n", 38162306a36Sopenharmony_ci die->max_port_id, die_idx); 38262306a36Sopenharmony_ci return -EINVAL; 38362306a36Sopenharmony_ci } 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci return 0; 38662306a36Sopenharmony_ci} 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_cistatic int hccs_query_all_die_info_on_platform(struct hccs_dev *hdev) 38962306a36Sopenharmony_ci{ 39062306a36Sopenharmony_ci struct device *dev = hdev->dev; 39162306a36Sopenharmony_ci struct hccs_chip_info *chip; 39262306a36Sopenharmony_ci struct hccs_die_info *die; 39362306a36Sopenharmony_ci u8 i, j; 39462306a36Sopenharmony_ci int ret; 39562306a36Sopenharmony_ci 39662306a36Sopenharmony_ci for (i = 0; i < hdev->chip_num; i++) { 39762306a36Sopenharmony_ci chip = &hdev->chips[i]; 39862306a36Sopenharmony_ci if (!chip->die_num) 39962306a36Sopenharmony_ci continue; 40062306a36Sopenharmony_ci 40162306a36Sopenharmony_ci chip->dies = devm_kzalloc(hdev->dev, 40262306a36Sopenharmony_ci chip->die_num * sizeof(struct hccs_die_info), 40362306a36Sopenharmony_ci GFP_KERNEL); 40462306a36Sopenharmony_ci if (!chip->dies) { 40562306a36Sopenharmony_ci dev_err(dev, "allocate all dies memory on chip%u failed.\n", 40662306a36Sopenharmony_ci i); 40762306a36Sopenharmony_ci return -ENOMEM; 40862306a36Sopenharmony_ci } 40962306a36Sopenharmony_ci 41062306a36Sopenharmony_ci for (j = 0; j < chip->die_num; j++) { 41162306a36Sopenharmony_ci die = &chip->dies[j]; 41262306a36Sopenharmony_ci ret = hccs_query_die_info_on_chip(hdev, i, j, die); 41362306a36Sopenharmony_ci if (ret) { 41462306a36Sopenharmony_ci dev_err(dev, "get die idx (%u) info on chip%u failed, ret = %d.\n", 41562306a36Sopenharmony_ci j, i, ret); 41662306a36Sopenharmony_ci return ret; 41762306a36Sopenharmony_ci } 41862306a36Sopenharmony_ci die->chip = chip; 41962306a36Sopenharmony_ci } 42062306a36Sopenharmony_ci } 42162306a36Sopenharmony_ci 42262306a36Sopenharmony_ci return 0; 42362306a36Sopenharmony_ci} 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_cistatic int hccs_get_bd_info(struct hccs_dev *hdev, u8 opcode, 42662306a36Sopenharmony_ci struct hccs_desc *desc, 42762306a36Sopenharmony_ci void *buf, size_t buf_len, 42862306a36Sopenharmony_ci struct hccs_rsp_head *rsp_head) 42962306a36Sopenharmony_ci{ 43062306a36Sopenharmony_ci struct hccs_rsp_head *head; 43162306a36Sopenharmony_ci struct hccs_rsp_desc *rsp; 43262306a36Sopenharmony_ci int ret; 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, opcode, desc); 43562306a36Sopenharmony_ci if (ret) 43662306a36Sopenharmony_ci return ret; 43762306a36Sopenharmony_ci 43862306a36Sopenharmony_ci rsp = &desc->rsp; 43962306a36Sopenharmony_ci head = &rsp->rsp_head; 44062306a36Sopenharmony_ci if (head->data_len > buf_len) { 44162306a36Sopenharmony_ci dev_err(hdev->dev, 44262306a36Sopenharmony_ci "buffer overflow (buf_len = %zu, data_len = %u)!\n", 44362306a36Sopenharmony_ci buf_len, head->data_len); 44462306a36Sopenharmony_ci return -ENOMEM; 44562306a36Sopenharmony_ci } 44662306a36Sopenharmony_ci 44762306a36Sopenharmony_ci memcpy(buf, rsp->data, head->data_len); 44862306a36Sopenharmony_ci *rsp_head = *head; 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_ci return 0; 45162306a36Sopenharmony_ci} 45262306a36Sopenharmony_ci 45362306a36Sopenharmony_cistatic int hccs_get_all_port_attr(struct hccs_dev *hdev, 45462306a36Sopenharmony_ci struct hccs_die_info *die, 45562306a36Sopenharmony_ci struct hccs_port_attr *attrs, u16 size) 45662306a36Sopenharmony_ci{ 45762306a36Sopenharmony_ci struct hccs_die_comm_req_param *req_param; 45862306a36Sopenharmony_ci struct hccs_req_head *req_head; 45962306a36Sopenharmony_ci struct hccs_rsp_head rsp_head; 46062306a36Sopenharmony_ci struct hccs_desc desc; 46162306a36Sopenharmony_ci size_t left_buf_len; 46262306a36Sopenharmony_ci u32 data_len = 0; 46362306a36Sopenharmony_ci u8 start_id; 46462306a36Sopenharmony_ci u8 *buf; 46562306a36Sopenharmony_ci int ret; 46662306a36Sopenharmony_ci 46762306a36Sopenharmony_ci buf = (u8 *)attrs; 46862306a36Sopenharmony_ci left_buf_len = sizeof(struct hccs_port_attr) * size; 46962306a36Sopenharmony_ci start_id = die->min_port_id; 47062306a36Sopenharmony_ci while (start_id <= die->max_port_id) { 47162306a36Sopenharmony_ci hccs_init_req_desc(&desc); 47262306a36Sopenharmony_ci req_head = &desc.req.req_head; 47362306a36Sopenharmony_ci req_head->start_id = start_id; 47462306a36Sopenharmony_ci req_param = (struct hccs_die_comm_req_param *)desc.req.data; 47562306a36Sopenharmony_ci req_param->chip_id = die->chip->chip_id; 47662306a36Sopenharmony_ci req_param->die_id = die->die_id; 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci ret = hccs_get_bd_info(hdev, HCCS_GET_DIE_PORT_INFO, &desc, 47962306a36Sopenharmony_ci buf + data_len, left_buf_len, &rsp_head); 48062306a36Sopenharmony_ci if (ret) { 48162306a36Sopenharmony_ci dev_err(hdev->dev, 48262306a36Sopenharmony_ci "get the information of port%u on die%u failed, ret = %d.\n", 48362306a36Sopenharmony_ci start_id, die->die_id, ret); 48462306a36Sopenharmony_ci return ret; 48562306a36Sopenharmony_ci } 48662306a36Sopenharmony_ci 48762306a36Sopenharmony_ci data_len += rsp_head.data_len; 48862306a36Sopenharmony_ci left_buf_len -= rsp_head.data_len; 48962306a36Sopenharmony_ci if (unlikely(rsp_head.next_id <= start_id)) { 49062306a36Sopenharmony_ci dev_err(hdev->dev, 49162306a36Sopenharmony_ci "next port id (%u) is not greater than last start id (%u) on die%u.\n", 49262306a36Sopenharmony_ci rsp_head.next_id, start_id, die->die_id); 49362306a36Sopenharmony_ci return -EINVAL; 49462306a36Sopenharmony_ci } 49562306a36Sopenharmony_ci start_id = rsp_head.next_id; 49662306a36Sopenharmony_ci } 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci return 0; 49962306a36Sopenharmony_ci} 50062306a36Sopenharmony_ci 50162306a36Sopenharmony_cistatic int hccs_get_all_port_info_on_die(struct hccs_dev *hdev, 50262306a36Sopenharmony_ci struct hccs_die_info *die) 50362306a36Sopenharmony_ci{ 50462306a36Sopenharmony_ci struct hccs_port_attr *attrs; 50562306a36Sopenharmony_ci struct hccs_port_info *port; 50662306a36Sopenharmony_ci int ret; 50762306a36Sopenharmony_ci u8 i; 50862306a36Sopenharmony_ci 50962306a36Sopenharmony_ci attrs = kcalloc(die->port_num, sizeof(struct hccs_port_attr), 51062306a36Sopenharmony_ci GFP_KERNEL); 51162306a36Sopenharmony_ci if (!attrs) 51262306a36Sopenharmony_ci return -ENOMEM; 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci ret = hccs_get_all_port_attr(hdev, die, attrs, die->port_num); 51562306a36Sopenharmony_ci if (ret) 51662306a36Sopenharmony_ci goto out; 51762306a36Sopenharmony_ci 51862306a36Sopenharmony_ci for (i = 0; i < die->port_num; i++) { 51962306a36Sopenharmony_ci port = &die->ports[i]; 52062306a36Sopenharmony_ci port->port_id = attrs[i].port_id; 52162306a36Sopenharmony_ci port->port_type = attrs[i].port_type; 52262306a36Sopenharmony_ci port->lane_mode = attrs[i].lane_mode; 52362306a36Sopenharmony_ci port->enable = attrs[i].enable; 52462306a36Sopenharmony_ci port->die = die; 52562306a36Sopenharmony_ci } 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_ciout: 52862306a36Sopenharmony_ci kfree(attrs); 52962306a36Sopenharmony_ci return ret; 53062306a36Sopenharmony_ci} 53162306a36Sopenharmony_ci 53262306a36Sopenharmony_cistatic int hccs_query_all_port_info_on_platform(struct hccs_dev *hdev) 53362306a36Sopenharmony_ci{ 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci struct device *dev = hdev->dev; 53662306a36Sopenharmony_ci struct hccs_chip_info *chip; 53762306a36Sopenharmony_ci struct hccs_die_info *die; 53862306a36Sopenharmony_ci u8 i, j; 53962306a36Sopenharmony_ci int ret; 54062306a36Sopenharmony_ci 54162306a36Sopenharmony_ci for (i = 0; i < hdev->chip_num; i++) { 54262306a36Sopenharmony_ci chip = &hdev->chips[i]; 54362306a36Sopenharmony_ci for (j = 0; j < chip->die_num; j++) { 54462306a36Sopenharmony_ci die = &chip->dies[j]; 54562306a36Sopenharmony_ci if (!die->port_num) 54662306a36Sopenharmony_ci continue; 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci die->ports = devm_kzalloc(dev, 54962306a36Sopenharmony_ci die->port_num * sizeof(struct hccs_port_info), 55062306a36Sopenharmony_ci GFP_KERNEL); 55162306a36Sopenharmony_ci if (!die->ports) { 55262306a36Sopenharmony_ci dev_err(dev, "allocate ports memory on chip%u/die%u failed.\n", 55362306a36Sopenharmony_ci i, die->die_id); 55462306a36Sopenharmony_ci return -ENOMEM; 55562306a36Sopenharmony_ci } 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_ci ret = hccs_get_all_port_info_on_die(hdev, die); 55862306a36Sopenharmony_ci if (ret) { 55962306a36Sopenharmony_ci dev_err(dev, "get all port info on chip%u/die%u failed, ret = %d.\n", 56062306a36Sopenharmony_ci i, die->die_id, ret); 56162306a36Sopenharmony_ci return ret; 56262306a36Sopenharmony_ci } 56362306a36Sopenharmony_ci } 56462306a36Sopenharmony_ci } 56562306a36Sopenharmony_ci 56662306a36Sopenharmony_ci return 0; 56762306a36Sopenharmony_ci} 56862306a36Sopenharmony_ci 56962306a36Sopenharmony_cistatic int hccs_get_hw_info(struct hccs_dev *hdev) 57062306a36Sopenharmony_ci{ 57162306a36Sopenharmony_ci int ret; 57262306a36Sopenharmony_ci 57362306a36Sopenharmony_ci ret = hccs_query_chip_info_on_platform(hdev); 57462306a36Sopenharmony_ci if (ret) { 57562306a36Sopenharmony_ci dev_err(hdev->dev, "query chip info on platform failed, ret = %d.\n", 57662306a36Sopenharmony_ci ret); 57762306a36Sopenharmony_ci return ret; 57862306a36Sopenharmony_ci } 57962306a36Sopenharmony_ci 58062306a36Sopenharmony_ci ret = hccs_query_all_die_info_on_platform(hdev); 58162306a36Sopenharmony_ci if (ret) { 58262306a36Sopenharmony_ci dev_err(hdev->dev, "query all die info on platform failed, ret = %d.\n", 58362306a36Sopenharmony_ci ret); 58462306a36Sopenharmony_ci return ret; 58562306a36Sopenharmony_ci } 58662306a36Sopenharmony_ci 58762306a36Sopenharmony_ci ret = hccs_query_all_port_info_on_platform(hdev); 58862306a36Sopenharmony_ci if (ret) { 58962306a36Sopenharmony_ci dev_err(hdev->dev, "query all port info on platform failed, ret = %d.\n", 59062306a36Sopenharmony_ci ret); 59162306a36Sopenharmony_ci return ret; 59262306a36Sopenharmony_ci } 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_ci return 0; 59562306a36Sopenharmony_ci} 59662306a36Sopenharmony_ci 59762306a36Sopenharmony_cistatic int hccs_query_port_link_status(struct hccs_dev *hdev, 59862306a36Sopenharmony_ci const struct hccs_port_info *port, 59962306a36Sopenharmony_ci struct hccs_link_status *link_status) 60062306a36Sopenharmony_ci{ 60162306a36Sopenharmony_ci const struct hccs_die_info *die = port->die; 60262306a36Sopenharmony_ci const struct hccs_chip_info *chip = die->chip; 60362306a36Sopenharmony_ci struct hccs_port_comm_req_param *req_param; 60462306a36Sopenharmony_ci struct hccs_desc desc; 60562306a36Sopenharmony_ci int ret; 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci hccs_init_req_desc(&desc); 60862306a36Sopenharmony_ci req_param = (struct hccs_port_comm_req_param *)desc.req.data; 60962306a36Sopenharmony_ci req_param->chip_id = chip->chip_id; 61062306a36Sopenharmony_ci req_param->die_id = die->die_id; 61162306a36Sopenharmony_ci req_param->port_id = port->port_id; 61262306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_PORT_LINK_STATUS, &desc); 61362306a36Sopenharmony_ci if (ret) { 61462306a36Sopenharmony_ci dev_err(hdev->dev, 61562306a36Sopenharmony_ci "get port link status info failed, ret = %d.\n", ret); 61662306a36Sopenharmony_ci return ret; 61762306a36Sopenharmony_ci } 61862306a36Sopenharmony_ci 61962306a36Sopenharmony_ci *link_status = *((struct hccs_link_status *)desc.rsp.data); 62062306a36Sopenharmony_ci 62162306a36Sopenharmony_ci return 0; 62262306a36Sopenharmony_ci} 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_cistatic int hccs_query_port_crc_err_cnt(struct hccs_dev *hdev, 62562306a36Sopenharmony_ci const struct hccs_port_info *port, 62662306a36Sopenharmony_ci u64 *crc_err_cnt) 62762306a36Sopenharmony_ci{ 62862306a36Sopenharmony_ci const struct hccs_die_info *die = port->die; 62962306a36Sopenharmony_ci const struct hccs_chip_info *chip = die->chip; 63062306a36Sopenharmony_ci struct hccs_port_comm_req_param *req_param; 63162306a36Sopenharmony_ci struct hccs_desc desc; 63262306a36Sopenharmony_ci int ret; 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_ci hccs_init_req_desc(&desc); 63562306a36Sopenharmony_ci req_param = (struct hccs_port_comm_req_param *)desc.req.data; 63662306a36Sopenharmony_ci req_param->chip_id = chip->chip_id; 63762306a36Sopenharmony_ci req_param->die_id = die->die_id; 63862306a36Sopenharmony_ci req_param->port_id = port->port_id; 63962306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_PORT_CRC_ERR_CNT, &desc); 64062306a36Sopenharmony_ci if (ret) { 64162306a36Sopenharmony_ci dev_err(hdev->dev, 64262306a36Sopenharmony_ci "get port crc error count failed, ret = %d.\n", ret); 64362306a36Sopenharmony_ci return ret; 64462306a36Sopenharmony_ci } 64562306a36Sopenharmony_ci 64662306a36Sopenharmony_ci memcpy(crc_err_cnt, &desc.rsp.data, sizeof(u64)); 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_ci return 0; 64962306a36Sopenharmony_ci} 65062306a36Sopenharmony_ci 65162306a36Sopenharmony_cistatic int hccs_get_die_all_link_status(struct hccs_dev *hdev, 65262306a36Sopenharmony_ci const struct hccs_die_info *die, 65362306a36Sopenharmony_ci u8 *all_linked) 65462306a36Sopenharmony_ci{ 65562306a36Sopenharmony_ci struct hccs_die_comm_req_param *req_param; 65662306a36Sopenharmony_ci struct hccs_desc desc; 65762306a36Sopenharmony_ci int ret; 65862306a36Sopenharmony_ci 65962306a36Sopenharmony_ci if (die->port_num == 0) { 66062306a36Sopenharmony_ci *all_linked = 1; 66162306a36Sopenharmony_ci return 0; 66262306a36Sopenharmony_ci } 66362306a36Sopenharmony_ci 66462306a36Sopenharmony_ci hccs_init_req_desc(&desc); 66562306a36Sopenharmony_ci req_param = (struct hccs_die_comm_req_param *)desc.req.data; 66662306a36Sopenharmony_ci req_param->chip_id = die->chip->chip_id; 66762306a36Sopenharmony_ci req_param->die_id = die->die_id; 66862306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_DIE_PORTS_LINK_STA, &desc); 66962306a36Sopenharmony_ci if (ret) { 67062306a36Sopenharmony_ci dev_err(hdev->dev, 67162306a36Sopenharmony_ci "get link status of all ports failed on die%u, ret = %d.\n", 67262306a36Sopenharmony_ci die->die_id, ret); 67362306a36Sopenharmony_ci return ret; 67462306a36Sopenharmony_ci } 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_ci *all_linked = *((u8 *)&desc.rsp.data); 67762306a36Sopenharmony_ci 67862306a36Sopenharmony_ci return 0; 67962306a36Sopenharmony_ci} 68062306a36Sopenharmony_ci 68162306a36Sopenharmony_cistatic int hccs_get_die_all_port_lane_status(struct hccs_dev *hdev, 68262306a36Sopenharmony_ci const struct hccs_die_info *die, 68362306a36Sopenharmony_ci u8 *full_lane) 68462306a36Sopenharmony_ci{ 68562306a36Sopenharmony_ci struct hccs_die_comm_req_param *req_param; 68662306a36Sopenharmony_ci struct hccs_desc desc; 68762306a36Sopenharmony_ci int ret; 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci if (die->port_num == 0) { 69062306a36Sopenharmony_ci *full_lane = 1; 69162306a36Sopenharmony_ci return 0; 69262306a36Sopenharmony_ci } 69362306a36Sopenharmony_ci 69462306a36Sopenharmony_ci hccs_init_req_desc(&desc); 69562306a36Sopenharmony_ci req_param = (struct hccs_die_comm_req_param *)desc.req.data; 69662306a36Sopenharmony_ci req_param->chip_id = die->chip->chip_id; 69762306a36Sopenharmony_ci req_param->die_id = die->die_id; 69862306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_DIE_PORTS_LANE_STA, &desc); 69962306a36Sopenharmony_ci if (ret) { 70062306a36Sopenharmony_ci dev_err(hdev->dev, "get lane status of all ports failed on die%u, ret = %d.\n", 70162306a36Sopenharmony_ci die->die_id, ret); 70262306a36Sopenharmony_ci return ret; 70362306a36Sopenharmony_ci } 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci *full_lane = *((u8 *)&desc.rsp.data); 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_ci return 0; 70862306a36Sopenharmony_ci} 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_cistatic int hccs_get_die_total_crc_err_cnt(struct hccs_dev *hdev, 71162306a36Sopenharmony_ci const struct hccs_die_info *die, 71262306a36Sopenharmony_ci u64 *total_crc_err_cnt) 71362306a36Sopenharmony_ci{ 71462306a36Sopenharmony_ci struct hccs_die_comm_req_param *req_param; 71562306a36Sopenharmony_ci struct hccs_desc desc; 71662306a36Sopenharmony_ci int ret; 71762306a36Sopenharmony_ci 71862306a36Sopenharmony_ci if (die->port_num == 0) { 71962306a36Sopenharmony_ci *total_crc_err_cnt = 0; 72062306a36Sopenharmony_ci return 0; 72162306a36Sopenharmony_ci } 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci hccs_init_req_desc(&desc); 72462306a36Sopenharmony_ci req_param = (struct hccs_die_comm_req_param *)desc.req.data; 72562306a36Sopenharmony_ci req_param->chip_id = die->chip->chip_id; 72662306a36Sopenharmony_ci req_param->die_id = die->die_id; 72762306a36Sopenharmony_ci ret = hccs_pcc_cmd_send(hdev, HCCS_GET_DIE_PORTS_CRC_ERR_CNT, &desc); 72862306a36Sopenharmony_ci if (ret) { 72962306a36Sopenharmony_ci dev_err(hdev->dev, "get crc error count sum failed on die%u, ret = %d.\n", 73062306a36Sopenharmony_ci die->die_id, ret); 73162306a36Sopenharmony_ci return ret; 73262306a36Sopenharmony_ci } 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci memcpy(total_crc_err_cnt, &desc.rsp.data, sizeof(u64)); 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_ci return 0; 73762306a36Sopenharmony_ci} 73862306a36Sopenharmony_ci 73962306a36Sopenharmony_cistatic ssize_t hccs_show(struct kobject *k, struct attribute *attr, char *buf) 74062306a36Sopenharmony_ci{ 74162306a36Sopenharmony_ci struct kobj_attribute *kobj_attr; 74262306a36Sopenharmony_ci 74362306a36Sopenharmony_ci kobj_attr = container_of(attr, struct kobj_attribute, attr); 74462306a36Sopenharmony_ci 74562306a36Sopenharmony_ci return kobj_attr->show(k, kobj_attr, buf); 74662306a36Sopenharmony_ci} 74762306a36Sopenharmony_ci 74862306a36Sopenharmony_cistatic const struct sysfs_ops hccs_comm_ops = { 74962306a36Sopenharmony_ci .show = hccs_show, 75062306a36Sopenharmony_ci}; 75162306a36Sopenharmony_ci 75262306a36Sopenharmony_cistatic ssize_t type_show(struct kobject *kobj, struct kobj_attribute *attr, 75362306a36Sopenharmony_ci char *buf) 75462306a36Sopenharmony_ci{ 75562306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 75662306a36Sopenharmony_ci 75762306a36Sopenharmony_ci return sysfs_emit(buf, "HCCS-v%u\n", port->port_type); 75862306a36Sopenharmony_ci} 75962306a36Sopenharmony_cistatic struct kobj_attribute hccs_type_attr = __ATTR_RO(type); 76062306a36Sopenharmony_ci 76162306a36Sopenharmony_cistatic ssize_t lane_mode_show(struct kobject *kobj, struct kobj_attribute *attr, 76262306a36Sopenharmony_ci char *buf) 76362306a36Sopenharmony_ci{ 76462306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 76562306a36Sopenharmony_ci 76662306a36Sopenharmony_ci return sysfs_emit(buf, "x%u\n", port->lane_mode); 76762306a36Sopenharmony_ci} 76862306a36Sopenharmony_cistatic struct kobj_attribute lane_mode_attr = __ATTR_RO(lane_mode); 76962306a36Sopenharmony_ci 77062306a36Sopenharmony_cistatic ssize_t enable_show(struct kobject *kobj, 77162306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 77262306a36Sopenharmony_ci{ 77362306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 77462306a36Sopenharmony_ci 77562306a36Sopenharmony_ci return sysfs_emit(buf, "%u\n", port->enable); 77662306a36Sopenharmony_ci} 77762306a36Sopenharmony_cistatic struct kobj_attribute port_enable_attr = __ATTR_RO(enable); 77862306a36Sopenharmony_ci 77962306a36Sopenharmony_cistatic ssize_t cur_lane_num_show(struct kobject *kobj, 78062306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 78162306a36Sopenharmony_ci{ 78262306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 78362306a36Sopenharmony_ci struct hccs_dev *hdev = port->die->chip->hdev; 78462306a36Sopenharmony_ci struct hccs_link_status link_status = {0}; 78562306a36Sopenharmony_ci int ret; 78662306a36Sopenharmony_ci 78762306a36Sopenharmony_ci mutex_lock(&hdev->lock); 78862306a36Sopenharmony_ci ret = hccs_query_port_link_status(hdev, port, &link_status); 78962306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 79062306a36Sopenharmony_ci if (ret) 79162306a36Sopenharmony_ci return ret; 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_ci return sysfs_emit(buf, "%u\n", link_status.lane_num); 79462306a36Sopenharmony_ci} 79562306a36Sopenharmony_cistatic struct kobj_attribute cur_lane_num_attr = __ATTR_RO(cur_lane_num); 79662306a36Sopenharmony_ci 79762306a36Sopenharmony_cistatic ssize_t link_fsm_show(struct kobject *kobj, 79862306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 79962306a36Sopenharmony_ci{ 80062306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 80162306a36Sopenharmony_ci struct hccs_dev *hdev = port->die->chip->hdev; 80262306a36Sopenharmony_ci struct hccs_link_status link_status = {0}; 80362306a36Sopenharmony_ci const struct { 80462306a36Sopenharmony_ci u8 link_fsm; 80562306a36Sopenharmony_ci char *str; 80662306a36Sopenharmony_ci } link_fsm_map[] = { 80762306a36Sopenharmony_ci {HCCS_PORT_RESET, "reset"}, 80862306a36Sopenharmony_ci {HCCS_PORT_SETUP, "setup"}, 80962306a36Sopenharmony_ci {HCCS_PORT_CONFIG, "config"}, 81062306a36Sopenharmony_ci {HCCS_PORT_READY, "link-up"}, 81162306a36Sopenharmony_ci }; 81262306a36Sopenharmony_ci const char *link_fsm_str = "unknown"; 81362306a36Sopenharmony_ci size_t i; 81462306a36Sopenharmony_ci int ret; 81562306a36Sopenharmony_ci 81662306a36Sopenharmony_ci mutex_lock(&hdev->lock); 81762306a36Sopenharmony_ci ret = hccs_query_port_link_status(hdev, port, &link_status); 81862306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 81962306a36Sopenharmony_ci if (ret) 82062306a36Sopenharmony_ci return ret; 82162306a36Sopenharmony_ci 82262306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(link_fsm_map); i++) { 82362306a36Sopenharmony_ci if (link_fsm_map[i].link_fsm == link_status.link_fsm) { 82462306a36Sopenharmony_ci link_fsm_str = link_fsm_map[i].str; 82562306a36Sopenharmony_ci break; 82662306a36Sopenharmony_ci } 82762306a36Sopenharmony_ci } 82862306a36Sopenharmony_ci 82962306a36Sopenharmony_ci return sysfs_emit(buf, "%s\n", link_fsm_str); 83062306a36Sopenharmony_ci} 83162306a36Sopenharmony_cistatic struct kobj_attribute link_fsm_attr = __ATTR_RO(link_fsm); 83262306a36Sopenharmony_ci 83362306a36Sopenharmony_cistatic ssize_t lane_mask_show(struct kobject *kobj, 83462306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 83562306a36Sopenharmony_ci{ 83662306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 83762306a36Sopenharmony_ci struct hccs_dev *hdev = port->die->chip->hdev; 83862306a36Sopenharmony_ci struct hccs_link_status link_status = {0}; 83962306a36Sopenharmony_ci int ret; 84062306a36Sopenharmony_ci 84162306a36Sopenharmony_ci mutex_lock(&hdev->lock); 84262306a36Sopenharmony_ci ret = hccs_query_port_link_status(hdev, port, &link_status); 84362306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 84462306a36Sopenharmony_ci if (ret) 84562306a36Sopenharmony_ci return ret; 84662306a36Sopenharmony_ci 84762306a36Sopenharmony_ci return sysfs_emit(buf, "0x%x\n", link_status.lane_mask); 84862306a36Sopenharmony_ci} 84962306a36Sopenharmony_cistatic struct kobj_attribute lane_mask_attr = __ATTR_RO(lane_mask); 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_cistatic ssize_t crc_err_cnt_show(struct kobject *kobj, 85262306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 85362306a36Sopenharmony_ci{ 85462306a36Sopenharmony_ci const struct hccs_port_info *port = kobj_to_port_info(kobj); 85562306a36Sopenharmony_ci struct hccs_dev *hdev = port->die->chip->hdev; 85662306a36Sopenharmony_ci u64 crc_err_cnt; 85762306a36Sopenharmony_ci int ret; 85862306a36Sopenharmony_ci 85962306a36Sopenharmony_ci mutex_lock(&hdev->lock); 86062306a36Sopenharmony_ci ret = hccs_query_port_crc_err_cnt(hdev, port, &crc_err_cnt); 86162306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 86262306a36Sopenharmony_ci if (ret) 86362306a36Sopenharmony_ci return ret; 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci return sysfs_emit(buf, "%llu\n", crc_err_cnt); 86662306a36Sopenharmony_ci} 86762306a36Sopenharmony_cistatic struct kobj_attribute crc_err_cnt_attr = __ATTR_RO(crc_err_cnt); 86862306a36Sopenharmony_ci 86962306a36Sopenharmony_cistatic struct attribute *hccs_port_default_attrs[] = { 87062306a36Sopenharmony_ci &hccs_type_attr.attr, 87162306a36Sopenharmony_ci &lane_mode_attr.attr, 87262306a36Sopenharmony_ci &port_enable_attr.attr, 87362306a36Sopenharmony_ci &cur_lane_num_attr.attr, 87462306a36Sopenharmony_ci &link_fsm_attr.attr, 87562306a36Sopenharmony_ci &lane_mask_attr.attr, 87662306a36Sopenharmony_ci &crc_err_cnt_attr.attr, 87762306a36Sopenharmony_ci NULL, 87862306a36Sopenharmony_ci}; 87962306a36Sopenharmony_ciATTRIBUTE_GROUPS(hccs_port_default); 88062306a36Sopenharmony_ci 88162306a36Sopenharmony_cistatic const struct kobj_type hccs_port_type = { 88262306a36Sopenharmony_ci .sysfs_ops = &hccs_comm_ops, 88362306a36Sopenharmony_ci .default_groups = hccs_port_default_groups, 88462306a36Sopenharmony_ci}; 88562306a36Sopenharmony_ci 88662306a36Sopenharmony_cistatic ssize_t all_linked_on_die_show(struct kobject *kobj, 88762306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 88862306a36Sopenharmony_ci{ 88962306a36Sopenharmony_ci const struct hccs_die_info *die = kobj_to_die_info(kobj); 89062306a36Sopenharmony_ci struct hccs_dev *hdev = die->chip->hdev; 89162306a36Sopenharmony_ci u8 all_linked; 89262306a36Sopenharmony_ci int ret; 89362306a36Sopenharmony_ci 89462306a36Sopenharmony_ci mutex_lock(&hdev->lock); 89562306a36Sopenharmony_ci ret = hccs_get_die_all_link_status(hdev, die, &all_linked); 89662306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 89762306a36Sopenharmony_ci if (ret) 89862306a36Sopenharmony_ci return ret; 89962306a36Sopenharmony_ci 90062306a36Sopenharmony_ci return sysfs_emit(buf, "%u\n", all_linked); 90162306a36Sopenharmony_ci} 90262306a36Sopenharmony_cistatic struct kobj_attribute all_linked_on_die_attr = 90362306a36Sopenharmony_ci __ATTR(all_linked, 0444, all_linked_on_die_show, NULL); 90462306a36Sopenharmony_ci 90562306a36Sopenharmony_cistatic ssize_t linked_full_lane_on_die_show(struct kobject *kobj, 90662306a36Sopenharmony_ci struct kobj_attribute *attr, 90762306a36Sopenharmony_ci char *buf) 90862306a36Sopenharmony_ci{ 90962306a36Sopenharmony_ci const struct hccs_die_info *die = kobj_to_die_info(kobj); 91062306a36Sopenharmony_ci struct hccs_dev *hdev = die->chip->hdev; 91162306a36Sopenharmony_ci u8 full_lane; 91262306a36Sopenharmony_ci int ret; 91362306a36Sopenharmony_ci 91462306a36Sopenharmony_ci mutex_lock(&hdev->lock); 91562306a36Sopenharmony_ci ret = hccs_get_die_all_port_lane_status(hdev, die, &full_lane); 91662306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 91762306a36Sopenharmony_ci if (ret) 91862306a36Sopenharmony_ci return ret; 91962306a36Sopenharmony_ci 92062306a36Sopenharmony_ci return sysfs_emit(buf, "%u\n", full_lane); 92162306a36Sopenharmony_ci} 92262306a36Sopenharmony_cistatic struct kobj_attribute linked_full_lane_on_die_attr = 92362306a36Sopenharmony_ci __ATTR(linked_full_lane, 0444, linked_full_lane_on_die_show, NULL); 92462306a36Sopenharmony_ci 92562306a36Sopenharmony_cistatic ssize_t crc_err_cnt_sum_on_die_show(struct kobject *kobj, 92662306a36Sopenharmony_ci struct kobj_attribute *attr, 92762306a36Sopenharmony_ci char *buf) 92862306a36Sopenharmony_ci{ 92962306a36Sopenharmony_ci const struct hccs_die_info *die = kobj_to_die_info(kobj); 93062306a36Sopenharmony_ci struct hccs_dev *hdev = die->chip->hdev; 93162306a36Sopenharmony_ci u64 total_crc_err_cnt; 93262306a36Sopenharmony_ci int ret; 93362306a36Sopenharmony_ci 93462306a36Sopenharmony_ci mutex_lock(&hdev->lock); 93562306a36Sopenharmony_ci ret = hccs_get_die_total_crc_err_cnt(hdev, die, &total_crc_err_cnt); 93662306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 93762306a36Sopenharmony_ci if (ret) 93862306a36Sopenharmony_ci return ret; 93962306a36Sopenharmony_ci 94062306a36Sopenharmony_ci return sysfs_emit(buf, "%llu\n", total_crc_err_cnt); 94162306a36Sopenharmony_ci} 94262306a36Sopenharmony_cistatic struct kobj_attribute crc_err_cnt_sum_on_die_attr = 94362306a36Sopenharmony_ci __ATTR(crc_err_cnt, 0444, crc_err_cnt_sum_on_die_show, NULL); 94462306a36Sopenharmony_ci 94562306a36Sopenharmony_cistatic struct attribute *hccs_die_default_attrs[] = { 94662306a36Sopenharmony_ci &all_linked_on_die_attr.attr, 94762306a36Sopenharmony_ci &linked_full_lane_on_die_attr.attr, 94862306a36Sopenharmony_ci &crc_err_cnt_sum_on_die_attr.attr, 94962306a36Sopenharmony_ci NULL, 95062306a36Sopenharmony_ci}; 95162306a36Sopenharmony_ciATTRIBUTE_GROUPS(hccs_die_default); 95262306a36Sopenharmony_ci 95362306a36Sopenharmony_cistatic const struct kobj_type hccs_die_type = { 95462306a36Sopenharmony_ci .sysfs_ops = &hccs_comm_ops, 95562306a36Sopenharmony_ci .default_groups = hccs_die_default_groups, 95662306a36Sopenharmony_ci}; 95762306a36Sopenharmony_ci 95862306a36Sopenharmony_cistatic ssize_t all_linked_on_chip_show(struct kobject *kobj, 95962306a36Sopenharmony_ci struct kobj_attribute *attr, char *buf) 96062306a36Sopenharmony_ci{ 96162306a36Sopenharmony_ci const struct hccs_chip_info *chip = kobj_to_chip_info(kobj); 96262306a36Sopenharmony_ci struct hccs_dev *hdev = chip->hdev; 96362306a36Sopenharmony_ci const struct hccs_die_info *die; 96462306a36Sopenharmony_ci u8 all_linked = 1; 96562306a36Sopenharmony_ci u8 i, tmp; 96662306a36Sopenharmony_ci int ret; 96762306a36Sopenharmony_ci 96862306a36Sopenharmony_ci mutex_lock(&hdev->lock); 96962306a36Sopenharmony_ci for (i = 0; i < chip->die_num; i++) { 97062306a36Sopenharmony_ci die = &chip->dies[i]; 97162306a36Sopenharmony_ci ret = hccs_get_die_all_link_status(hdev, die, &tmp); 97262306a36Sopenharmony_ci if (ret) { 97362306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 97462306a36Sopenharmony_ci return ret; 97562306a36Sopenharmony_ci } 97662306a36Sopenharmony_ci if (tmp != all_linked) { 97762306a36Sopenharmony_ci all_linked = 0; 97862306a36Sopenharmony_ci break; 97962306a36Sopenharmony_ci } 98062306a36Sopenharmony_ci } 98162306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 98262306a36Sopenharmony_ci 98362306a36Sopenharmony_ci return sysfs_emit(buf, "%u\n", all_linked); 98462306a36Sopenharmony_ci} 98562306a36Sopenharmony_cistatic struct kobj_attribute all_linked_on_chip_attr = 98662306a36Sopenharmony_ci __ATTR(all_linked, 0444, all_linked_on_chip_show, NULL); 98762306a36Sopenharmony_ci 98862306a36Sopenharmony_cistatic ssize_t linked_full_lane_on_chip_show(struct kobject *kobj, 98962306a36Sopenharmony_ci struct kobj_attribute *attr, 99062306a36Sopenharmony_ci char *buf) 99162306a36Sopenharmony_ci{ 99262306a36Sopenharmony_ci const struct hccs_chip_info *chip = kobj_to_chip_info(kobj); 99362306a36Sopenharmony_ci struct hccs_dev *hdev = chip->hdev; 99462306a36Sopenharmony_ci const struct hccs_die_info *die; 99562306a36Sopenharmony_ci u8 full_lane = 1; 99662306a36Sopenharmony_ci u8 i, tmp; 99762306a36Sopenharmony_ci int ret; 99862306a36Sopenharmony_ci 99962306a36Sopenharmony_ci mutex_lock(&hdev->lock); 100062306a36Sopenharmony_ci for (i = 0; i < chip->die_num; i++) { 100162306a36Sopenharmony_ci die = &chip->dies[i]; 100262306a36Sopenharmony_ci ret = hccs_get_die_all_port_lane_status(hdev, die, &tmp); 100362306a36Sopenharmony_ci if (ret) { 100462306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 100562306a36Sopenharmony_ci return ret; 100662306a36Sopenharmony_ci } 100762306a36Sopenharmony_ci if (tmp != full_lane) { 100862306a36Sopenharmony_ci full_lane = 0; 100962306a36Sopenharmony_ci break; 101062306a36Sopenharmony_ci } 101162306a36Sopenharmony_ci } 101262306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 101362306a36Sopenharmony_ci 101462306a36Sopenharmony_ci return sysfs_emit(buf, "%u\n", full_lane); 101562306a36Sopenharmony_ci} 101662306a36Sopenharmony_cistatic struct kobj_attribute linked_full_lane_on_chip_attr = 101762306a36Sopenharmony_ci __ATTR(linked_full_lane, 0444, linked_full_lane_on_chip_show, NULL); 101862306a36Sopenharmony_ci 101962306a36Sopenharmony_cistatic ssize_t crc_err_cnt_sum_on_chip_show(struct kobject *kobj, 102062306a36Sopenharmony_ci struct kobj_attribute *attr, 102162306a36Sopenharmony_ci char *buf) 102262306a36Sopenharmony_ci{ 102362306a36Sopenharmony_ci const struct hccs_chip_info *chip = kobj_to_chip_info(kobj); 102462306a36Sopenharmony_ci u64 crc_err_cnt, total_crc_err_cnt = 0; 102562306a36Sopenharmony_ci struct hccs_dev *hdev = chip->hdev; 102662306a36Sopenharmony_ci const struct hccs_die_info *die; 102762306a36Sopenharmony_ci int ret; 102862306a36Sopenharmony_ci u16 i; 102962306a36Sopenharmony_ci 103062306a36Sopenharmony_ci mutex_lock(&hdev->lock); 103162306a36Sopenharmony_ci for (i = 0; i < chip->die_num; i++) { 103262306a36Sopenharmony_ci die = &chip->dies[i]; 103362306a36Sopenharmony_ci ret = hccs_get_die_total_crc_err_cnt(hdev, die, &crc_err_cnt); 103462306a36Sopenharmony_ci if (ret) { 103562306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 103662306a36Sopenharmony_ci return ret; 103762306a36Sopenharmony_ci } 103862306a36Sopenharmony_ci 103962306a36Sopenharmony_ci total_crc_err_cnt += crc_err_cnt; 104062306a36Sopenharmony_ci } 104162306a36Sopenharmony_ci mutex_unlock(&hdev->lock); 104262306a36Sopenharmony_ci 104362306a36Sopenharmony_ci return sysfs_emit(buf, "%llu\n", total_crc_err_cnt); 104462306a36Sopenharmony_ci} 104562306a36Sopenharmony_cistatic struct kobj_attribute crc_err_cnt_sum_on_chip_attr = 104662306a36Sopenharmony_ci __ATTR(crc_err_cnt, 0444, crc_err_cnt_sum_on_chip_show, NULL); 104762306a36Sopenharmony_ci 104862306a36Sopenharmony_cistatic struct attribute *hccs_chip_default_attrs[] = { 104962306a36Sopenharmony_ci &all_linked_on_chip_attr.attr, 105062306a36Sopenharmony_ci &linked_full_lane_on_chip_attr.attr, 105162306a36Sopenharmony_ci &crc_err_cnt_sum_on_chip_attr.attr, 105262306a36Sopenharmony_ci NULL, 105362306a36Sopenharmony_ci}; 105462306a36Sopenharmony_ciATTRIBUTE_GROUPS(hccs_chip_default); 105562306a36Sopenharmony_ci 105662306a36Sopenharmony_cistatic const struct kobj_type hccs_chip_type = { 105762306a36Sopenharmony_ci .sysfs_ops = &hccs_comm_ops, 105862306a36Sopenharmony_ci .default_groups = hccs_chip_default_groups, 105962306a36Sopenharmony_ci}; 106062306a36Sopenharmony_ci 106162306a36Sopenharmony_cistatic void hccs_remove_die_dir(struct hccs_die_info *die) 106262306a36Sopenharmony_ci{ 106362306a36Sopenharmony_ci struct hccs_port_info *port; 106462306a36Sopenharmony_ci u8 i; 106562306a36Sopenharmony_ci 106662306a36Sopenharmony_ci for (i = 0; i < die->port_num; i++) { 106762306a36Sopenharmony_ci port = &die->ports[i]; 106862306a36Sopenharmony_ci if (port->dir_created) 106962306a36Sopenharmony_ci kobject_put(&port->kobj); 107062306a36Sopenharmony_ci } 107162306a36Sopenharmony_ci 107262306a36Sopenharmony_ci kobject_put(&die->kobj); 107362306a36Sopenharmony_ci} 107462306a36Sopenharmony_ci 107562306a36Sopenharmony_cistatic void hccs_remove_chip_dir(struct hccs_chip_info *chip) 107662306a36Sopenharmony_ci{ 107762306a36Sopenharmony_ci struct hccs_die_info *die; 107862306a36Sopenharmony_ci u8 i; 107962306a36Sopenharmony_ci 108062306a36Sopenharmony_ci for (i = 0; i < chip->die_num; i++) { 108162306a36Sopenharmony_ci die = &chip->dies[i]; 108262306a36Sopenharmony_ci if (die->dir_created) 108362306a36Sopenharmony_ci hccs_remove_die_dir(die); 108462306a36Sopenharmony_ci } 108562306a36Sopenharmony_ci 108662306a36Sopenharmony_ci kobject_put(&chip->kobj); 108762306a36Sopenharmony_ci} 108862306a36Sopenharmony_ci 108962306a36Sopenharmony_cistatic void hccs_remove_topo_dirs(struct hccs_dev *hdev) 109062306a36Sopenharmony_ci{ 109162306a36Sopenharmony_ci u8 i; 109262306a36Sopenharmony_ci 109362306a36Sopenharmony_ci for (i = 0; i < hdev->chip_num; i++) 109462306a36Sopenharmony_ci hccs_remove_chip_dir(&hdev->chips[i]); 109562306a36Sopenharmony_ci} 109662306a36Sopenharmony_ci 109762306a36Sopenharmony_cistatic int hccs_create_hccs_dir(struct hccs_dev *hdev, 109862306a36Sopenharmony_ci struct hccs_die_info *die, 109962306a36Sopenharmony_ci struct hccs_port_info *port) 110062306a36Sopenharmony_ci{ 110162306a36Sopenharmony_ci int ret; 110262306a36Sopenharmony_ci 110362306a36Sopenharmony_ci ret = kobject_init_and_add(&port->kobj, &hccs_port_type, 110462306a36Sopenharmony_ci &die->kobj, "hccs%d", port->port_id); 110562306a36Sopenharmony_ci if (ret) { 110662306a36Sopenharmony_ci kobject_put(&port->kobj); 110762306a36Sopenharmony_ci return ret; 110862306a36Sopenharmony_ci } 110962306a36Sopenharmony_ci 111062306a36Sopenharmony_ci return 0; 111162306a36Sopenharmony_ci} 111262306a36Sopenharmony_ci 111362306a36Sopenharmony_cistatic int hccs_create_die_dir(struct hccs_dev *hdev, 111462306a36Sopenharmony_ci struct hccs_chip_info *chip, 111562306a36Sopenharmony_ci struct hccs_die_info *die) 111662306a36Sopenharmony_ci{ 111762306a36Sopenharmony_ci struct hccs_port_info *port; 111862306a36Sopenharmony_ci int ret; 111962306a36Sopenharmony_ci u16 i; 112062306a36Sopenharmony_ci 112162306a36Sopenharmony_ci ret = kobject_init_and_add(&die->kobj, &hccs_die_type, 112262306a36Sopenharmony_ci &chip->kobj, "die%d", die->die_id); 112362306a36Sopenharmony_ci if (ret) { 112462306a36Sopenharmony_ci kobject_put(&die->kobj); 112562306a36Sopenharmony_ci return ret; 112662306a36Sopenharmony_ci } 112762306a36Sopenharmony_ci 112862306a36Sopenharmony_ci for (i = 0; i < die->port_num; i++) { 112962306a36Sopenharmony_ci port = &die->ports[i]; 113062306a36Sopenharmony_ci ret = hccs_create_hccs_dir(hdev, die, port); 113162306a36Sopenharmony_ci if (ret) { 113262306a36Sopenharmony_ci dev_err(hdev->dev, "create hccs%d dir failed.\n", 113362306a36Sopenharmony_ci port->port_id); 113462306a36Sopenharmony_ci goto err; 113562306a36Sopenharmony_ci } 113662306a36Sopenharmony_ci port->dir_created = true; 113762306a36Sopenharmony_ci } 113862306a36Sopenharmony_ci 113962306a36Sopenharmony_ci return 0; 114062306a36Sopenharmony_cierr: 114162306a36Sopenharmony_ci hccs_remove_die_dir(die); 114262306a36Sopenharmony_ci 114362306a36Sopenharmony_ci return ret; 114462306a36Sopenharmony_ci} 114562306a36Sopenharmony_ci 114662306a36Sopenharmony_cistatic int hccs_create_chip_dir(struct hccs_dev *hdev, 114762306a36Sopenharmony_ci struct hccs_chip_info *chip) 114862306a36Sopenharmony_ci{ 114962306a36Sopenharmony_ci struct hccs_die_info *die; 115062306a36Sopenharmony_ci int ret; 115162306a36Sopenharmony_ci u16 id; 115262306a36Sopenharmony_ci 115362306a36Sopenharmony_ci ret = kobject_init_and_add(&chip->kobj, &hccs_chip_type, 115462306a36Sopenharmony_ci &hdev->dev->kobj, "chip%d", chip->chip_id); 115562306a36Sopenharmony_ci if (ret) { 115662306a36Sopenharmony_ci kobject_put(&chip->kobj); 115762306a36Sopenharmony_ci return ret; 115862306a36Sopenharmony_ci } 115962306a36Sopenharmony_ci 116062306a36Sopenharmony_ci for (id = 0; id < chip->die_num; id++) { 116162306a36Sopenharmony_ci die = &chip->dies[id]; 116262306a36Sopenharmony_ci ret = hccs_create_die_dir(hdev, chip, die); 116362306a36Sopenharmony_ci if (ret) 116462306a36Sopenharmony_ci goto err; 116562306a36Sopenharmony_ci die->dir_created = true; 116662306a36Sopenharmony_ci } 116762306a36Sopenharmony_ci 116862306a36Sopenharmony_ci return 0; 116962306a36Sopenharmony_cierr: 117062306a36Sopenharmony_ci hccs_remove_chip_dir(chip); 117162306a36Sopenharmony_ci 117262306a36Sopenharmony_ci return ret; 117362306a36Sopenharmony_ci} 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_cistatic int hccs_create_topo_dirs(struct hccs_dev *hdev) 117662306a36Sopenharmony_ci{ 117762306a36Sopenharmony_ci struct hccs_chip_info *chip; 117862306a36Sopenharmony_ci u8 id, k; 117962306a36Sopenharmony_ci int ret; 118062306a36Sopenharmony_ci 118162306a36Sopenharmony_ci for (id = 0; id < hdev->chip_num; id++) { 118262306a36Sopenharmony_ci chip = &hdev->chips[id]; 118362306a36Sopenharmony_ci ret = hccs_create_chip_dir(hdev, chip); 118462306a36Sopenharmony_ci if (ret) { 118562306a36Sopenharmony_ci dev_err(hdev->dev, "init chip%d dir failed!\n", id); 118662306a36Sopenharmony_ci goto err; 118762306a36Sopenharmony_ci } 118862306a36Sopenharmony_ci } 118962306a36Sopenharmony_ci 119062306a36Sopenharmony_ci return 0; 119162306a36Sopenharmony_cierr: 119262306a36Sopenharmony_ci for (k = 0; k < id; k++) 119362306a36Sopenharmony_ci hccs_remove_chip_dir(&hdev->chips[k]); 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ci return ret; 119662306a36Sopenharmony_ci} 119762306a36Sopenharmony_ci 119862306a36Sopenharmony_cistatic int hccs_probe(struct platform_device *pdev) 119962306a36Sopenharmony_ci{ 120062306a36Sopenharmony_ci struct acpi_device *acpi_dev; 120162306a36Sopenharmony_ci struct hccs_dev *hdev; 120262306a36Sopenharmony_ci int rc; 120362306a36Sopenharmony_ci 120462306a36Sopenharmony_ci if (acpi_disabled) { 120562306a36Sopenharmony_ci dev_err(&pdev->dev, "acpi is disabled.\n"); 120662306a36Sopenharmony_ci return -ENODEV; 120762306a36Sopenharmony_ci } 120862306a36Sopenharmony_ci acpi_dev = ACPI_COMPANION(&pdev->dev); 120962306a36Sopenharmony_ci if (!acpi_dev) 121062306a36Sopenharmony_ci return -ENODEV; 121162306a36Sopenharmony_ci 121262306a36Sopenharmony_ci hdev = devm_kzalloc(&pdev->dev, sizeof(*hdev), GFP_KERNEL); 121362306a36Sopenharmony_ci if (!hdev) 121462306a36Sopenharmony_ci return -ENOMEM; 121562306a36Sopenharmony_ci hdev->acpi_dev = acpi_dev; 121662306a36Sopenharmony_ci hdev->dev = &pdev->dev; 121762306a36Sopenharmony_ci platform_set_drvdata(pdev, hdev); 121862306a36Sopenharmony_ci 121962306a36Sopenharmony_ci mutex_init(&hdev->lock); 122062306a36Sopenharmony_ci rc = hccs_get_pcc_chan_id(hdev); 122162306a36Sopenharmony_ci if (rc) 122262306a36Sopenharmony_ci return rc; 122362306a36Sopenharmony_ci rc = hccs_register_pcc_channel(hdev); 122462306a36Sopenharmony_ci if (rc) 122562306a36Sopenharmony_ci return rc; 122662306a36Sopenharmony_ci 122762306a36Sopenharmony_ci rc = hccs_get_dev_caps(hdev); 122862306a36Sopenharmony_ci if (rc) 122962306a36Sopenharmony_ci goto unregister_pcc_chan; 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_ci rc = hccs_get_hw_info(hdev); 123262306a36Sopenharmony_ci if (rc) 123362306a36Sopenharmony_ci goto unregister_pcc_chan; 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_ci rc = hccs_create_topo_dirs(hdev); 123662306a36Sopenharmony_ci if (rc) 123762306a36Sopenharmony_ci goto unregister_pcc_chan; 123862306a36Sopenharmony_ci 123962306a36Sopenharmony_ci return 0; 124062306a36Sopenharmony_ci 124162306a36Sopenharmony_ciunregister_pcc_chan: 124262306a36Sopenharmony_ci hccs_unregister_pcc_channel(hdev); 124362306a36Sopenharmony_ci 124462306a36Sopenharmony_ci return rc; 124562306a36Sopenharmony_ci} 124662306a36Sopenharmony_ci 124762306a36Sopenharmony_cistatic int hccs_remove(struct platform_device *pdev) 124862306a36Sopenharmony_ci{ 124962306a36Sopenharmony_ci struct hccs_dev *hdev = platform_get_drvdata(pdev); 125062306a36Sopenharmony_ci 125162306a36Sopenharmony_ci hccs_remove_topo_dirs(hdev); 125262306a36Sopenharmony_ci hccs_unregister_pcc_channel(hdev); 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_ci return 0; 125562306a36Sopenharmony_ci} 125662306a36Sopenharmony_ci 125762306a36Sopenharmony_cistatic const struct acpi_device_id hccs_acpi_match[] = { 125862306a36Sopenharmony_ci { "HISI04B1"}, 125962306a36Sopenharmony_ci { ""}, 126062306a36Sopenharmony_ci}; 126162306a36Sopenharmony_ciMODULE_DEVICE_TABLE(acpi, hccs_acpi_match); 126262306a36Sopenharmony_ci 126362306a36Sopenharmony_cistatic struct platform_driver hccs_driver = { 126462306a36Sopenharmony_ci .probe = hccs_probe, 126562306a36Sopenharmony_ci .remove = hccs_remove, 126662306a36Sopenharmony_ci .driver = { 126762306a36Sopenharmony_ci .name = "kunpeng_hccs", 126862306a36Sopenharmony_ci .acpi_match_table = hccs_acpi_match, 126962306a36Sopenharmony_ci }, 127062306a36Sopenharmony_ci}; 127162306a36Sopenharmony_ci 127262306a36Sopenharmony_cimodule_platform_driver(hccs_driver); 127362306a36Sopenharmony_ci 127462306a36Sopenharmony_ciMODULE_DESCRIPTION("Kunpeng SoC HCCS driver"); 127562306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 127662306a36Sopenharmony_ciMODULE_AUTHOR("Huisong Li <lihuisong@huawei.com>"); 1277