From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1754064AbcHRKMg (ORCPT ); Thu, 18 Aug 2016 06:12:36 -0400 Received: from mail-wm0-f46.google.com ([74.125.82.46]:34728 "EHLO mail-wm0-f46.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1947060AbcHRKLb (ORCPT ); Thu, 18 Aug 2016 06:11:31 -0400 From: Neil Armstrong To: linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, sudeep.holla@arm.com Cc: Neil Armstrong , linux-amlogic@lists.infradead.org, khilman@baylibre.com, heiko@sntech.de, wxt@rock-chips.com, frank.wang@rock-chips.com Subject: [PATCH 09/13] scpi: implement rockchip support via the vendor_msg mechanism Date: Thu, 18 Aug 2016 12:11:02 +0200 Message-Id: <1471515066-3626-10-git-send-email-narmstrong@baylibre.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1471515066-3626-1-git-send-email-narmstrong@baylibre.com> References: <1471515066-3626-1-git-send-email-narmstrong@baylibre.com> Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org In order to support the Rockchip legacy procotol, implement the vendor mailbox specific functions and add ops to the of_match table. Signed-off-by: Neil Armstrong --- drivers/firmware/arm_scpi.c | 43 +++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 43 insertions(+) diff --git a/drivers/firmware/arm_scpi.c b/drivers/firmware/arm_scpi.c index 275feef..d73db7c 100644 --- a/drivers/firmware/arm_scpi.c +++ b/drivers/firmware/arm_scpi.c @@ -455,6 +455,37 @@ static int legacy_scpi_get_chan(u8 cmd) return 0; } +/* Rockchip SoCs needs a special structure as a message */ + +struct rockchip_scpi_xfer { + u32 cmd; + int rx_size; +}; + +static int rockchip_init(struct device *dev, struct scpi_chan *chan) +{ + chan->vendor_data = devm_kmalloc(dev, + sizeof(struct rockchip_scpi_xfer), + GFP_KERNEL); + if (!chan->vendor_data) + return -ENOMEM; + + return 0; +} + +static int rockchip_prepare(struct scpi_chan *chan) +{ + struct scpi_xfer *msg = chan->t; + struct rockchip_scpi_xfer *xfer = chan->vendor_data; + + xfer->cmd = msg->cmd; + xfer->rx_size = msg->rx_len; + + msg->vendor_msg = xfer; + + return 0; +} + static struct scpi_xfer *get_scpi_xfer(struct scpi_chan *ch) { struct scpi_xfer *t; @@ -1026,9 +1057,21 @@ static const struct priv_scpi_ops scpi_legacy_ops = { .scpi_ops = &legacy_scpi_ops, }; +static const struct priv_scpi_ops scpi_rockchip_ops = { + .init = rockchip_init, + .prepare = rockchip_prepare, + .handle_remote_msg = legacy_scpi_handle_remote_msg, + .tx_prepare = legacy_scpi_tx_prepare, + .init_versions = legacy_scpi_init_versions, + .dvfs_get_info = legacy_scpi_dvfs_get_info, + .scpi_ops = &legacy_scpi_ops, +}; + static const struct of_device_id scpi_of_match[] = { {.compatible = "arm,scpi"}, {.compatible = "amlogic,meson-gxbb-scpi", .data = &scpi_legacy_ops}, + {.compatible = "rockchip,rk3368-scpi", .data = &scpi_rockchip_ops}, + {.compatible = "rockchip,rk3399-scpi", .data = &scpi_rockchip_ops}, {}, }; -- 1.9.1