From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lf1-f50.google.com (mail-lf1-f50.google.com [209.85.167.50]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 083FB16D4FD for ; Tue, 25 Jun 2024 14:54:31 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.167.50 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327273; cv=none; b=UYqqR2L2fwMKrCI10tWGgTE7+cpUGBmxpZ7oenyghu95ZWaWWmcsq0lZoyxEjW9Ru6b3qnj2/eHl1clynwTrkq1MqNDf+rov+MCiUCc0u7LLZNbrheelJDRJb7JleljCG+TmcR2wGzQM6i2Ybem2COj7pSdhPsRXKSINLduOlvg= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327273; c=relaxed/simple; bh=E+vOJjv2UvdlrXvKnRgzVGWs8xl24PgUq84JxgbpN+M=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=mOVKtzWKl/Hg/WofKCcIqzeDdJxOTwWQh3e3sPzsgoFVNJ4YlzxsjmRs03pHGNtm+GHLJ1MZxY5BSrotxMMIDiyz56hcAfs6lSSJBCcPbmkphRnFN5Bup/1fG8AI+yfCCwrIWmDRLTXp4+xBgv0dP8cBf5vnMniqLZh2tl9/CvA= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=ot8D9QpH; arc=none smtp.client-ip=209.85.167.50 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="ot8D9QpH" Received: by mail-lf1-f50.google.com with SMTP id 2adb3069b0e04-52bbf73f334so4352316e87.2 for ; Tue, 25 Jun 2024 07:54:31 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327270; x=1719932070; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=JAfmKGbaHSRN3BDyb2Ps0ChAgC9WErixxC6u5jSyHcs=; b=ot8D9QpH0Xknfeg0Zy7p5K+JY98y55p+aozKKMdlJ0TInRBT9ZaZUkxHFxC5NzATSx TFWPcowvZvVWhuzfn67ldXmKbn28sIEx8A/qQUieuKfG/bZoLSFyqP6EE2ddX7VyFolp IwB+J4wNr9oYLrC4eqcRDV4/bbCsjQXhP7eOe1bjujUEhRIpsO2k6gl/4pyqiReVeUdZ ajXuYUBYmokH1oyMeSqLO8hYaqt//bk+WEjUf7daLXMz7lP45QH+0hPCjb6Cu+kl7Xhs 7pqBcD7lLK0vsYHUZelP0nPDP8axRfruo3M+GZJW60XqWUdLruD5ScNecRZMxWHVZCQD YYiQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327270; x=1719932070; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=JAfmKGbaHSRN3BDyb2Ps0ChAgC9WErixxC6u5jSyHcs=; b=JlfAGAXQjCDBquLYqhvnStGV+JTrE28xY48ZzYp/1W98SIF8+wSj1l+XjNRT1QNwyx 9v/AProJW1ZIq1bK2PnukhydrSXEjDUNwH0u344EfBBxwdaZk56x8nbWXYzLrIoARnwi cqr3EN42Pdn5OSmPTDiJcFMjnnat886UoyKzw+v1J8RC6rXdsEpUYu7RRMdMwJS26VM5 FeHJCHHMRCcxXEa+ZUY2G2MKE9afU8w6K6kZk21cDlY5EEX8oQtZ/r5ph14BLK7d7IM4 51SNIyrsmjCSUti8elGTAQyORUJmuZWOemsQyCmiTLHr7A3uyMaJRZZ42wOI4jhOd8aL 912Q== X-Forwarded-Encrypted: i=1; AJvYcCUmytzTQUD1lVR/pumz/gmb2r8dtf8WXs+Thqz3A/xMRhUtckitFzXJoFZJRTTFY4qaMsCoEDDgjxNUIGZZ2cnLW1NgaQbcCnuDtF9D X-Gm-Message-State: AOJu0YxQUnKjnvSD5P8JL9v1dr0U39UoWG0/vYhgBzLkveo2sjcDB1QB 4cZfi4MgllBPysG0Tgoiuldvim4vAQW6RVNoo3gFnKefM4kVBlypCf8mP5TU+Lw= X-Google-Smtp-Source: AGHT+IGZFf/nSGa2e2d62pxL5I+qOFEUEnjG9EKzs41xvEO8rAlHlgWJuddbGqx0uxqUQDIYsbz3Rw== X-Received: by 2002:a05:6512:453:b0:52c:d943:300f with SMTP id 2adb3069b0e04-52cdf7f6705mr5392914e87.38.1719327270161; Tue, 25 Jun 2024 07:54:30 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.29 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:29 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:26 +0300 Subject: [PATCH v3 1/7] usb: typec: ucsi: move ucsi_acknowledge() from ucsi_read_error() Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-1-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=1294; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=E+vOJjv2UvdlrXvKnRgzVGWs8xl24PgUq84JxgbpN+M=; b=owEBbQGS/pANAwAKAYs8ij4CKSjVAcsmYgBmetojmtp4D7cmDhXFyPFb6rzvpO9SqHUmDn68o x84cE4DSNWJATMEAAEKAB0WIQRMcISVXLJjVvC4lX+LPIo+Aiko1QUCZnraIwAKCRCLPIo+Aiko 1dsqB/wKU/73Da/F7fXX3mKihmmgqnEt8z5DsYc/2Ek86sZ2QOVH5pcoOyQjGE2tEHJM1A460DU fniZ9SvZ17LHTf335zpqrqK1baAzCc7as/KU5FPsnsANZRV0di+AWzepIIFaNaN3bkEDgvyhGv3 D9plJZY56ZqgzDBYL4OkX/69YyQk2ndc/DcQOa6sbOSLN+5tjeH9gnPwh9coPGY9Cf2n3auuqJz 1jSXserA6xSdR0TK2kuorPqnD+k9K6yufTUWdeB5SNheTQwuDx4uTO2SUb42q1522ZwVKmxA7Bp KSyWF53xjvQ5qHB3NY1c+iU9Gf62IqbUUg5WbVjtBFRAZ1HM X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A As a preparation for reworking UCSI command handling, move ucsi_acknowledge() for the failed command from ucsi_read_error() to ucsi_exec_command(). Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 16 ++++++---------- 1 file changed, 6 insertions(+), 10 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index 76c48d873b2a..297d939e8da8 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -70,11 +70,6 @@ static int ucsi_read_error(struct ucsi *ucsi) u16 error; int ret; =20 - /* Acknowledge the command that failed */ - ret =3D ucsi_acknowledge(ucsi, false); - if (ret) - return ret; - ret =3D ucsi_exec_command(ucsi, UCSI_GET_ERROR_STATUS); if (ret < 0) return ret; @@ -153,13 +148,14 @@ static int ucsi_exec_command(struct ucsi *ucsi, u64 c= md) } =20 if (cci & UCSI_CCI_ERROR) { - if (cmd =3D=3D UCSI_GET_ERROR_STATUS) { - ret =3D ucsi_acknowledge(ucsi, false); - if (ret) - return ret; + /* Acknowledge the command that failed */ + ret =3D ucsi_acknowledge(ucsi, false); + if (ret) + return ret; =20 + if (cmd =3D=3D UCSI_GET_ERROR_STATUS) return -EIO; - } + return ucsi_read_error(ucsi); } =20 --=20 2.39.2 From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lf1-f53.google.com (mail-lf1-f53.google.com [209.85.167.53]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id C30BC16D9C1 for ; Tue, 25 Jun 2024 14:54:32 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.167.53 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327275; cv=none; b=jm/+wjmICKVBWlH/yaAc89CJnsJj0rUN1bK8w+hLIYSV7TcGwPcn9S0wt9Hrh4FLssskzPsLgn+fv72+5kEDX72nX5lY29UnY4J8LgR7bcf99+Oe4ixqMythURwINFGohIlXzbA7JEAicAM2ifxZqlJTTu6diBnUx5GM4SWd1Cc= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327275; c=relaxed/simple; bh=CEvbvB7gJ/H3MYji/elAM+3tUMhYqRgw3bCCMI7tq6c=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=MnnRABd2kTwfoj4G1kTcRgeH6gt2lkGcgjSX+RiO4yY0tdmsmJLCbTzaD7enrlE5szl2KBxWpwvvZ5q319tfKuVkJOSPtVL0b/C8HHLpG/5XWL+Prly8pjVPxTk6YV9N8npMwViv0psE0DLPYL/mAHrAZVzhU/6DXWxmZAm8qEM= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=siXzvUSb; arc=none smtp.client-ip=209.85.167.53 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="siXzvUSb" Received: by mail-lf1-f53.google.com with SMTP id 2adb3069b0e04-52cf4ca8904so428021e87.3 for ; Tue, 25 Jun 2024 07:54:32 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327271; x=1719932071; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=7LEiFtfgfs0Ngipd4ntmJnXIdkp4mmOLM3swdnA1V8U=; b=siXzvUSbCZRFg4mAFwp2sLY3cLxRoVuGXR76XiXORXpEhhEtvK/aUPt/ufbKWWssYu 0l9eLCtQFa7s7MoVxQhMZ3akKw3Nv75e4i7bzSWGhF3tgXhCWbg7djuGEinj7hUIONvl QBnl6dwObTKrAQfQKyD5/lWQNxjN7qlPS75lPLakmua7e9ogD+CQJUoxtN0y0N7vfcld Agn6FH2QYHa74pn1BejMgwMH9mrKIAjIGSwMb/hC4EYpuAmP66ve4v0ADfZvzNNlmn2m C0l7gHHLRMtYLesAAiOubDDwiGrXvmg40iRooID0qKD0QekszvvvrT+mRt3LxFqSodJ1 EM/A== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327271; x=1719932071; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=7LEiFtfgfs0Ngipd4ntmJnXIdkp4mmOLM3swdnA1V8U=; b=lelczLc9mxj/n9pvrGWJL3G3h6buKy9ZGalIThqTl3h2ix8zgLJW3pduuvvoGVPTJI S3ruPWpndCilVL0PtEwO+58vRKo4BAeFEz+6V9LT13pRBnn1rtifTTC752rJA9Efe2lf dHQ86Vq6SYd5ho2mk0Sy7O8fVVXO0MhBtu71BT9batlF565O5+l7MKVTi/2vWbXmAj7u zSsn44HlTwXFVVGsF9WNCCui2erGbbVK4Wd8LcKvD2Ymy5vJB7bJ3k5lg+iwk07q3n+Q yAZJOWPo5g0gkzZeHqyRWkDtgaMjXRLf2Ab2twUeaPf7/d/sXsvD8LL82o8Jc+qezlOl LFbw== X-Forwarded-Encrypted: i=1; AJvYcCXR7g1t+DDkJ6XjbqRTYniRzPHhi/m0r5gOZy2o0IPUVjmM8YOFFuOIDFMOSxzqDHqsdcUrUamOFmtMAW3kuLydMrddZXHGSFIp2Y4g X-Gm-Message-State: AOJu0YypkxG9Qo2uzY04iyRqicPywyfylKl/Uzpsom6vUjvAsaEPXAs4 qfYUiDnccM9ETJs9nsd2xcIZoHAhgFGN3iEeXSBFDP8zmxjMJrYnQcckD6Z/Yhk= X-Google-Smtp-Source: AGHT+IFF6rSU92qoqZYqmPJ7GZVrJ4GdjaT3kYYiAox4XIiLATWxaA6Yqp82cc6AN1alytvjPcOf9w== X-Received: by 2002:a19:700d:0:b0:52c:df90:203b with SMTP id 2adb3069b0e04-52ce0680324mr4031473e87.56.1719327270943; Tue, 25 Jun 2024 07:54:30 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.30 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:30 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:27 +0300 Subject: [PATCH v3 2/7] usb: typec: ucsi: simplify command sending API Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-2-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=17266; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=CEvbvB7gJ/H3MYji/elAM+3tUMhYqRgw3bCCMI7tq6c=; b=owEBbQGS/pANAwAKAYs8ij4CKSjVAcsmYgBmetojeYJ2SPPKAueLrxUGEqYqt29fy+1b8hmE9 AdjEIQc5zOJATMEAAEKAB0WIQRMcISVXLJjVvC4lX+LPIo+Aiko1QUCZnraIwAKCRCLPIo+Aiko 1eolB/0RMUBUttUqaEx5AdUlrGhbzYzR91kJ7QFCP0NILdTtC52gZoHAeTDjXy8YEU7qDH3MdHZ 5+85mSqeIA89apvxJU0RQzYX4uQH913N+WuNHMj+KF4v+7ZF8CiD2mtMU1N0Y6ML8yq/TX1IstE JtSeuZFs6wEkUNCy57sPnm9dnOi9MQ7sBf4KvRSi6wt1oAOpw1GHn4tJmHj3hMmj+KoSIc3zAYe 2hk7+5DbYNHsT8OA3wsHcc4HdDwOopupWp6ZEMBCxENcwUEtki3rMXvBq+TA2z5aoofULPVPxUV Z7sokLiWNWi0jf3DyfPRuyhvC+2+R+IJpswDMqtItcftcZvi X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A The sync_write and async_write are used only for writing UCSI commands to the UCSI_CONTROL offsets. Rename sync_write and async_write operations to sync_control and async_control accordingly. Drop the offset and length fields and pass u64 command instead. Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 18 +++++++---------- drivers/usb/typec/ucsi/ucsi.h | 10 ++++------ drivers/usb/typec/ucsi/ucsi_acpi.c | 31 ++++++++++++++---------------- drivers/usb/typec/ucsi/ucsi_ccg.c | 34 +++++++++++++++--------------= ---- drivers/usb/typec/ucsi/ucsi_glink.c | 14 ++++++-------- drivers/usb/typec/ucsi/ucsi_stm32g0.c | 24 +++++++++++------------ drivers/usb/typec/ucsi/ucsi_yoga_c630.c | 20 +++++++------------ 7 files changed, 64 insertions(+), 87 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index 297d939e8da8..52903eea7274 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -60,7 +60,7 @@ static int ucsi_acknowledge(struct ucsi *ucsi, bool conn_= ack) ctrl |=3D UCSI_ACK_CONNECTOR_CHANGE; } =20 - return ucsi->ops->sync_write(ucsi, UCSI_CONTROL, &ctrl, sizeof(ctrl)); + return ucsi->ops->sync_control(ucsi, ctrl); } =20 static int ucsi_exec_command(struct ucsi *ucsi, u64 command); @@ -126,7 +126,7 @@ static int ucsi_exec_command(struct ucsi *ucsi, u64 cmd) u32 cci; int ret; =20 - ret =3D ucsi->ops->sync_write(ucsi, UCSI_CONTROL, &cmd, sizeof(cmd)); + ret =3D ucsi->ops->sync_control(ucsi, cmd); if (ret) return ret; =20 @@ -1321,8 +1321,7 @@ static int ucsi_reset_ppm(struct ucsi *ucsi) */ if (cci & UCSI_CCI_RESET_COMPLETE) { command =3D UCSI_SET_NOTIFICATION_ENABLE; - ret =3D ucsi->ops->async_write(ucsi, UCSI_CONTROL, &command, - sizeof(command)); + ret =3D ucsi->ops->async_control(ucsi, command); if (ret < 0) goto out; =20 @@ -1343,8 +1342,7 @@ static int ucsi_reset_ppm(struct ucsi *ucsi) } =20 command =3D UCSI_PPM_RESET; - ret =3D ucsi->ops->async_write(ucsi, UCSI_CONTROL, &command, - sizeof(command)); + ret =3D ucsi->ops->async_control(ucsi, command); if (ret < 0) goto out; =20 @@ -1365,9 +1363,7 @@ static int ucsi_reset_ppm(struct ucsi *ucsi) =20 /* If the PPM is still doing something else, reset it again. */ if (cci & ~UCSI_CCI_RESET_COMPLETE) { - ret =3D ucsi->ops->async_write(ucsi, UCSI_CONTROL, - &command, - sizeof(command)); + ret =3D ucsi->ops->async_control(ucsi, command); if (ret < 0) goto out; } @@ -1895,7 +1891,7 @@ struct ucsi *ucsi_create(struct device *dev, const st= ruct ucsi_operations *ops) { struct ucsi *ucsi; =20 - if (!ops || !ops->read || !ops->sync_write || !ops->async_write) + if (!ops || !ops->read || !ops->sync_control || !ops->async_control) return ERR_PTR(-EINVAL); =20 ucsi =3D kzalloc(sizeof(*ucsi), GFP_KERNEL); @@ -1971,7 +1967,7 @@ void ucsi_unregister(struct ucsi *ucsi) cancel_work_sync(&ucsi->resume_work); =20 /* Disable notifications */ - ucsi->ops->async_write(ucsi, UCSI_CONTROL, &cmd, sizeof(cmd)); + ucsi->ops->async_control(ucsi, cmd); =20 if (!ucsi->connector) return; diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h index 1280cac314fe..3ad64acffda1 100644 --- a/drivers/usb/typec/ucsi/ucsi.h +++ b/drivers/usb/typec/ucsi/ucsi.h @@ -57,8 +57,8 @@ struct dentry; /** * struct ucsi_operations - UCSI I/O operations * @read: Read operation - * @sync_write: Blocking write operation - * @async_write: Non-blocking write operation + * @sync_control: Blocking control operation + * @async_control: Non-blocking control operation * @update_altmodes: Squashes duplicate DP altmodes * @update_connector: Update connector capabilities before registering * @connector_status: Updates connector status, called holding connector l= ock @@ -70,10 +70,8 @@ struct dentry; struct ucsi_operations { int (*read)(struct ucsi *ucsi, unsigned int offset, void *val, size_t val_len); - int (*sync_write)(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len); - int (*async_write)(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len); + int (*sync_control)(struct ucsi *ucsi, u64 command); + int (*async_control)(struct ucsi *ucsi, u64 command); bool (*update_altmodes)(struct ucsi *ucsi, struct ucsi_altmode *orig, struct ucsi_altmode *updated); void (*update_connector)(struct ucsi_connector *con); diff --git a/drivers/usb/typec/ucsi/ucsi_acpi.c b/drivers/usb/typec/ucsi/uc= si_acpi.c index adf32ca0f761..f54e4722d8f6 100644 --- a/drivers/usb/typec/ucsi/ucsi_acpi.c +++ b/drivers/usb/typec/ucsi/ucsi_acpi.c @@ -61,22 +61,20 @@ static int ucsi_acpi_read(struct ucsi *ucsi, unsigned i= nt offset, return 0; } =20 -static int ucsi_acpi_async_write(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len) +static int ucsi_acpi_async_control(struct ucsi *ucsi, u64 command) { struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); =20 - memcpy(ua->base + offset, val, val_len); - ua->cmd =3D *(u64 *)val; + memcpy(ua->base + UCSI_CONTROL, &command, sizeof(command)); + ua->cmd =3D command; =20 return ucsi_acpi_dsm(ua, UCSI_DSM_FUNC_WRITE); } =20 -static int ucsi_acpi_sync_write(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len) +static int ucsi_acpi_sync_control(struct ucsi *ucsi, u64 command) { struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); - bool ack =3D UCSI_COMMAND(*(u64 *)val) =3D=3D UCSI_ACK_CC_CI; + bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; int ret; =20 if (ack) @@ -84,7 +82,7 @@ static int ucsi_acpi_sync_write(struct ucsi *ucsi, unsign= ed int offset, else set_bit(UCSI_ACPI_COMMAND_PENDING, &ua->flags); =20 - ret =3D ucsi_acpi_async_write(ucsi, offset, val, val_len); + ret =3D ucsi_acpi_async_control(ucsi, command); if (ret) goto out_clear_bit; =20 @@ -102,8 +100,8 @@ static int ucsi_acpi_sync_write(struct ucsi *ucsi, unsi= gned int offset, =20 static const struct ucsi_operations ucsi_acpi_ops =3D { .read =3D ucsi_acpi_read, - .sync_write =3D ucsi_acpi_sync_write, - .async_write =3D ucsi_acpi_async_write + .sync_control =3D ucsi_acpi_sync_control, + .async_control =3D ucsi_acpi_async_control }; =20 static int @@ -125,8 +123,8 @@ ucsi_zenbook_read(struct ucsi *ucsi, unsigned int offse= t, void *val, size_t val_ =20 static const struct ucsi_operations ucsi_zenbook_ops =3D { .read =3D ucsi_zenbook_read, - .sync_write =3D ucsi_acpi_sync_write, - .async_write =3D ucsi_acpi_async_write + .sync_control =3D ucsi_acpi_sync_control, + .async_control =3D ucsi_acpi_async_control }; =20 static int ucsi_gram_read(struct ucsi *ucsi, unsigned int offset, @@ -157,13 +155,12 @@ static int ucsi_gram_read(struct ucsi *ucsi, unsigned= int offset, return ret; } =20 -static int ucsi_gram_sync_write(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len) +static int ucsi_gram_sync_control(struct ucsi *ucsi, u64 command) { struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); int ret; =20 - ret =3D ucsi_acpi_sync_write(ucsi, offset, val, val_len); + ret =3D ucsi_acpi_sync_control(ucsi, command); if (ret < 0) return ret; =20 @@ -177,8 +174,8 @@ static int ucsi_gram_sync_write(struct ucsi *ucsi, unsi= gned int offset, =20 static const struct ucsi_operations ucsi_gram_ops =3D { .read =3D ucsi_gram_read, - .sync_write =3D ucsi_gram_sync_write, - .async_write =3D ucsi_acpi_async_write + .sync_control =3D ucsi_gram_sync_control, + .async_control =3D ucsi_acpi_async_control }; =20 static const struct dmi_system_id ucsi_acpi_quirks[] =3D { diff --git a/drivers/usb/typec/ucsi/ucsi_ccg.c b/drivers/usb/typec/ucsi/ucs= i_ccg.c index dda7c7c94e08..76b39bb9762d 100644 --- a/drivers/usb/typec/ucsi/ucsi_ccg.c +++ b/drivers/usb/typec/ucsi/ucsi_ccg.c @@ -610,25 +610,23 @@ static int ucsi_ccg_read(struct ucsi *ucsi, unsigned = int offset, return ret; } =20 -static int ucsi_ccg_async_write(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len) +static int ucsi_ccg_async_control(struct ucsi *ucsi, u64 command) { struct ucsi_ccg *uc =3D ucsi_get_drvdata(ucsi); - u16 reg =3D CCGX_RAB_UCSI_DATA_BLOCK(offset); + u16 reg =3D CCGX_RAB_UCSI_DATA_BLOCK(UCSI_CONTROL); =20 /* - * UCSI may read CCI instantly after async_write, + * UCSI may read CCI instantly after async_control, * clear CCI to avoid caller getting wrong data before we get CCI from ISR */ spin_lock(&uc->op_lock); uc->op_data.cci =3D 0; spin_unlock(&uc->op_lock); =20 - return ccg_write(uc, reg, val, val_len); + return ccg_write(uc, reg, (u8 *)&command, sizeof(command)); } =20 -static int ucsi_ccg_sync_write(struct ucsi *ucsi, unsigned int offset, - const void *val, size_t val_len) +static int ucsi_ccg_sync_control(struct ucsi *ucsi, u64 command) { struct ucsi_ccg *uc =3D ucsi_get_drvdata(ucsi); struct ucsi_connector *con; @@ -639,19 +637,17 @@ static int ucsi_ccg_sync_write(struct ucsi *ucsi, uns= igned int offset, pm_runtime_get_sync(uc->dev); set_bit(DEV_CMD_PENDING, &uc->flags); =20 - if (offset =3D=3D UCSI_CONTROL && val_len =3D=3D sizeof(uc->last_cmd_sent= )) { - uc->last_cmd_sent =3D *(u64 *)val; + uc->last_cmd_sent =3D command; =20 - if (UCSI_COMMAND(uc->last_cmd_sent) =3D=3D UCSI_SET_NEW_CAM && - uc->has_multiple_dp) { - con_index =3D (uc->last_cmd_sent >> 16) & - UCSI_CMD_CONNECTOR_MASK; - con =3D &uc->ucsi->connector[con_index - 1]; - ucsi_ccg_update_set_new_cam_cmd(uc, con, (u64 *)val); - } + if (UCSI_COMMAND(uc->last_cmd_sent) =3D=3D UCSI_SET_NEW_CAM && + uc->has_multiple_dp) { + con_index =3D (uc->last_cmd_sent >> 16) & + UCSI_CMD_CONNECTOR_MASK; + con =3D &uc->ucsi->connector[con_index - 1]; + ucsi_ccg_update_set_new_cam_cmd(uc, con, &command); } =20 - ret =3D ucsi_ccg_async_write(ucsi, offset, val, val_len); + ret =3D ucsi_ccg_async_control(ucsi, command); if (ret) goto err_clear_bit; =20 @@ -668,8 +664,8 @@ static int ucsi_ccg_sync_write(struct ucsi *ucsi, unsig= ned int offset, =20 static const struct ucsi_operations ucsi_ccg_ops =3D { .read =3D ucsi_ccg_read, - .sync_write =3D ucsi_ccg_sync_write, - .async_write =3D ucsi_ccg_async_write, + .sync_control =3D ucsi_ccg_sync_control, + .async_control =3D ucsi_ccg_async_control, .update_altmodes =3D ucsi_ccg_update_altmodes }; =20 diff --git a/drivers/usb/typec/ucsi/ucsi_glink.c b/drivers/usb/typec/ucsi/u= csi_glink.c index 2fa973afe4e6..ebd76257c4fc 100644 --- a/drivers/usb/typec/ucsi/ucsi_glink.c +++ b/drivers/usb/typec/ucsi/ucsi_glink.c @@ -143,21 +143,19 @@ static int pmic_glink_ucsi_locked_write(struct pmic_g= link_ucsi *ucsi, unsigned i return 0; } =20 -static int pmic_glink_ucsi_async_write(struct ucsi *__ucsi, unsigned int o= ffset, - const void *val, size_t val_len) +static int pmic_glink_ucsi_async_control(struct ucsi *__ucsi, u64 command) { struct pmic_glink_ucsi *ucsi =3D ucsi_get_drvdata(__ucsi); int ret; =20 mutex_lock(&ucsi->lock); - ret =3D pmic_glink_ucsi_locked_write(ucsi, offset, val, val_len); + ret =3D pmic_glink_ucsi_locked_write(ucsi, UCSI_CONTROL, &command, sizeof= (command)); mutex_unlock(&ucsi->lock); =20 return ret; } =20 -static int pmic_glink_ucsi_sync_write(struct ucsi *__ucsi, unsigned int of= fset, - const void *val, size_t val_len) +static int pmic_glink_ucsi_sync_control(struct ucsi *__ucsi, u64 command) { struct pmic_glink_ucsi *ucsi =3D ucsi_get_drvdata(__ucsi); unsigned long left; @@ -169,7 +167,7 @@ static int pmic_glink_ucsi_sync_write(struct ucsi *__uc= si, unsigned int offset, ucsi->sync_val =3D 0; reinit_completion(&ucsi->sync_ack); ucsi->sync_pending =3D true; - ret =3D pmic_glink_ucsi_locked_write(ucsi, offset, val, val_len); + ret =3D pmic_glink_ucsi_locked_write(ucsi, UCSI_CONTROL, &command, sizeof= (command)); mutex_unlock(&ucsi->lock); =20 left =3D wait_for_completion_timeout(&ucsi->sync_ack, 5 * HZ); @@ -217,8 +215,8 @@ static void pmic_glink_ucsi_connector_status(struct ucs= i_connector *con) =20 static const struct ucsi_operations pmic_glink_ucsi_ops =3D { .read =3D pmic_glink_ucsi_read, - .sync_write =3D pmic_glink_ucsi_sync_write, - .async_write =3D pmic_glink_ucsi_async_write, + .sync_control =3D pmic_glink_ucsi_sync_control, + .async_control =3D pmic_glink_ucsi_async_control, .update_connector =3D pmic_glink_ucsi_update_connector, .connector_status =3D pmic_glink_ucsi_connector_status, }; diff --git a/drivers/usb/typec/ucsi/ucsi_stm32g0.c b/drivers/usb/typec/ucsi= /ucsi_stm32g0.c index ac69288e8bb0..396e2090e7c3 100644 --- a/drivers/usb/typec/ucsi/ucsi_stm32g0.c +++ b/drivers/usb/typec/ucsi/ucsi_stm32g0.c @@ -359,8 +359,7 @@ static int ucsi_stm32g0_read(struct ucsi *ucsi, unsigne= d int offset, void *val, return 0; } =20 -static int ucsi_stm32g0_async_write(struct ucsi *ucsi, unsigned int offset= , const void *val, - size_t len) +static int ucsi_stm32g0_async_control(struct ucsi *ucsi, u64 command) { struct ucsi_stm32g0 *g0 =3D ucsi_get_drvdata(ucsi); struct i2c_client *client =3D g0->client; @@ -373,19 +372,19 @@ static int ucsi_stm32g0_async_write(struct ucsi *ucsi= , unsigned int offset, cons unsigned char *buf; int ret; =20 - buf =3D kmalloc(len + 1, GFP_KERNEL); + buf =3D kmalloc(sizeof(command) + 1, GFP_KERNEL); if (!buf) return -ENOMEM; =20 - buf[0] =3D offset; - memcpy(&buf[1], val, len); - msg[0].len =3D len + 1; + buf[0] =3D UCSI_CONTROL; + memcpy(&buf[1], &command, sizeof(command)); + msg[0].len =3D sizeof(command) + 1; msg[0].buf =3D buf; =20 ret =3D i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); kfree(buf); if (ret !=3D ARRAY_SIZE(msg)) { - dev_err(g0->dev, "i2c write %02x, %02x error: %d\n", client->addr, offse= t, ret); + dev_err(g0->dev, "i2c write %02x, %02x error: %d\n", client->addr, UCSI_= CONTROL, ret); =20 return ret < 0 ? ret : -EIO; } @@ -393,11 +392,10 @@ static int ucsi_stm32g0_async_write(struct ucsi *ucsi= , unsigned int offset, cons return 0; } =20 -static int ucsi_stm32g0_sync_write(struct ucsi *ucsi, unsigned int offset,= const void *val, - size_t len) +static int ucsi_stm32g0_sync_control(struct ucsi *ucsi, u64 command) { struct ucsi_stm32g0 *g0 =3D ucsi_get_drvdata(ucsi); - bool ack =3D UCSI_COMMAND(*(u64 *)val) =3D=3D UCSI_ACK_CC_CI; + bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; int ret; =20 if (ack) @@ -405,7 +403,7 @@ static int ucsi_stm32g0_sync_write(struct ucsi *ucsi, u= nsigned int offset, const else set_bit(COMMAND_PENDING, &g0->flags); =20 - ret =3D ucsi_stm32g0_async_write(ucsi, offset, val, len); + ret =3D ucsi_stm32g0_async_control(ucsi, command); if (ret) goto out_clear_bit; =20 @@ -449,8 +447,8 @@ static irqreturn_t ucsi_stm32g0_irq_handler(int irq, vo= id *data) =20 static const struct ucsi_operations ucsi_stm32g0_ops =3D { .read =3D ucsi_stm32g0_read, - .sync_write =3D ucsi_stm32g0_sync_write, - .async_write =3D ucsi_stm32g0_async_write, + .sync_control =3D ucsi_stm32g0_sync_control, + .async_control =3D ucsi_stm32g0_async_control, }; =20 static int ucsi_stm32g0_register(struct ucsi *ucsi) diff --git a/drivers/usb/typec/ucsi/ucsi_yoga_c630.c b/drivers/usb/typec/uc= si/ucsi_yoga_c630.c index 8bee0b469041..e5e8ba0c0eaa 100644 --- a/drivers/usb/typec/ucsi/ucsi_yoga_c630.c +++ b/drivers/usb/typec/ucsi/ucsi_yoga_c630.c @@ -56,23 +56,17 @@ static int yoga_c630_ucsi_read(struct ucsi *ucsi, unsig= ned int offset, } } =20 -static int yoga_c630_ucsi_async_write(struct ucsi *ucsi, unsigned int offs= et, - const void *val, size_t val_len) +static int yoga_c630_ucsi_async_control(struct ucsi *ucsi, u64 command) { struct yoga_c630_ucsi *uec =3D ucsi_get_drvdata(ucsi); =20 - if (offset !=3D UCSI_CONTROL || - val_len !=3D YOGA_C630_UCSI_WRITE_SIZE) - return -EINVAL; - - return yoga_c630_ec_ucsi_write(uec->ec, val); + return yoga_c630_ec_ucsi_write(uec->ec, (u8*)&command); } =20 -static int yoga_c630_ucsi_sync_write(struct ucsi *ucsi, unsigned int offse= t, - const void *val, size_t val_len) +static int yoga_c630_ucsi_sync_control(struct ucsi *ucsi, u64 command) { struct yoga_c630_ucsi *uec =3D ucsi_get_drvdata(ucsi); - bool ack =3D UCSI_COMMAND(*(u64 *)val) =3D=3D UCSI_ACK_CC_CI; + bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; int ret; =20 if (ack) @@ -82,7 +76,7 @@ static int yoga_c630_ucsi_sync_write(struct ucsi *ucsi, u= nsigned int offset, =20 reinit_completion(&uec->complete); =20 - ret =3D yoga_c630_ucsi_async_write(ucsi, offset, val, val_len); + ret =3D yoga_c630_ucsi_async_control(ucsi, command); if (ret) goto out_clear_bit; =20 @@ -100,8 +94,8 @@ static int yoga_c630_ucsi_sync_write(struct ucsi *ucsi, = unsigned int offset, =20 const struct ucsi_operations yoga_c630_ucsi_ops =3D { .read =3D yoga_c630_ucsi_read, - .sync_write =3D yoga_c630_ucsi_sync_write, - .async_write =3D yoga_c630_ucsi_async_write, + .sync_control =3D yoga_c630_ucsi_sync_control, + .async_control =3D yoga_c630_ucsi_async_control, }; =20 static void yoga_c630_ucsi_notify_ucsi(struct yoga_c630_ucsi *uec, u32 cci) --=20 2.39.2 From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lf1-f43.google.com (mail-lf1-f43.google.com [209.85.167.43]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 79B0E16F0F4 for ; Tue, 25 Jun 2024 14:54:34 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.167.43 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327277; cv=none; b=MoTueoozcN5NTqy5ynWWksirn5Wx3whACFI6QV3erNPz16yti6oNFKafGa7tS7rvfuwb1pqKU57xi/sNuL9Mn8eZv/mt0w6yppaBW4yo2WLrkSPCAUaFdso8kMv8kmgnHWaW6Jc/iqKNBSIxcnf/+haihIE7J9ApTMmCZHGKbMo= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327277; c=relaxed/simple; bh=4wZHRHUTLDa+Ajur4pcLq9kjg9ZZkfOeNHnW5AjdB+U=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=lEn/n5T71KxFR7p3hSUtAlrIw0UT9GzJ2jq99wItnF3y8WyNGCbcql8QqBC5Gdhfo0hdTlE72x+jwQxHM/9p/vaRkMYin/7c5mgLAahuxEmaLzDIIXbT6F2hqkwbYnizbwKEXpZNX5OoU9K8LHymOdgrAy9KEJ9U7u2yS8DoIfg= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=EOgUbgky; arc=none smtp.client-ip=209.85.167.43 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="EOgUbgky" Received: by mail-lf1-f43.google.com with SMTP id 2adb3069b0e04-52cd628f21cso4817266e87.3 for ; Tue, 25 Jun 2024 07:54:34 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327272; x=1719932072; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=JHzYKHNjBXf+9UzjvIdsaqBY3cbTBbTnQBUGbCvbkus=; b=EOgUbgkylyYKGo6OYlr4LUtG9dXh3I4yyLbigphEN1dzUcm00R21FIA/8l5ZL4NNDS O4/T87OnWLbGwz5H2yO9J/2Y/QFD4OyK654074SYYLPLNpmzMndDBzXKweb8hyczlSR/ UpVPe+teHkBbt8lP+ZcNMT+TDgPVArXOo2En9QXlvA/ns7JO4PkcytLLplTqCiRQDPIe 3nqat28UbGB6z4KnjjVEMAdVoOBNkW61ondZJHC6JDT4JRx0DRSNEVkbNmKPZKEvqpOz YSr9/is7c2ZzsCF+2cFWBctRr1eq771TJe2QYP8Ibp+X3bPqtIm9VQVdYlM8xt6pZtNs Acfw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327272; x=1719932072; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=JHzYKHNjBXf+9UzjvIdsaqBY3cbTBbTnQBUGbCvbkus=; b=rt+v4MS8+19hoDTNKu5Rj0P+7nfzbjwhvi9SHoVdZ5WEaN94kPye6KrIknMPhCBzUZ VBLNRPnp/bGDSgJPvbJwaW0vv3110iedkSlQ9NS3QdHPMFz4+SSZJWjkVLcWobjVikkL uygGWeFWFU0XedQCrXpmKESOOEDz3epzB4WYE1YpuCySRQx3I7wC3Oaj9OBSAjI83wWN 9SiqucVp7fIZ5mgrvASZzFnHpQ97DLms123epOiCYfx2MksotvscG9zPBcQkCBlE5KRF ydxc3eNINNjvw3t1oV5knDFhIhpQU5fFOqRn5O4RyD4FtZ3G24V7DgSzphVNmk3uTu+p 2fwA== X-Forwarded-Encrypted: i=1; AJvYcCWSdVDVpanB+yPbtQoDko6OVXjF+QdMoqCvV68Ieif/YZlO+KoUf61NfTR1oXN0oe/DPrF8Zr6Vmtt3vd1iAOhlbeDcSyZemOPv0z9n X-Gm-Message-State: AOJu0YzIKQrlopB0LUrGBdQMr6ATUWYjlTN2+BUI6OwELkWmYgXkI1Wa YCXhfXK1tv4kfiVKfZV4jg2Op6XVickshEt1HFC6wnacu3g18ivZyY7XC7N7uV8= X-Google-Smtp-Source: AGHT+IGhqQ+VBKIxaQ2lp2Pfy14XvRHw9UB90ZVR4jtUgoXS1297PMq+RIWx0NHafF59+uQIKs23DQ== X-Received: by 2002:ac2:550d:0:b0:52c:e126:3d50 with SMTP id 2adb3069b0e04-52ce183bf44mr4231354e87.36.1719327271692; Tue, 25 Jun 2024 07:54:31 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.31 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:31 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:28 +0300 Subject: [PATCH v3 3/7] usb: typec: ucsi: split read operation Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-3-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=16964; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=4wZHRHUTLDa+Ajur4pcLq9kjg9ZZkfOeNHnW5AjdB+U=; b=owEBbQGS/pANAwAKAYs8ij4CKSjVAcsmYgBmetojz5ODXJomc1rapxF2ktWVUz9a/WEel79T5 OixCXVC8qKJATMEAAEKAB0WIQRMcISVXLJjVvC4lX+LPIo+Aiko1QUCZnraIwAKCRCLPIo+Aiko 1YChB/9blK+zkNFOWhPUzE/TGHcI/2rtvvJI4F2Rg9lNVf8REPX01zLsxS7WGfj3I0CoSHjDJBm KvwwE/ZRjiTrLYdW4RxTF97d6LJQF2O6lWpXemKOfr/teiJav76MobxTQia8x/EV2Zlgw2e0KHi 9z5a9a8P1IsN6lAYlX2k9C75bn249CnAHnvCvqwfoa5Ea42VBS0ytYxLq5AdJ8x1/fFSV/vDBKt JiXwyITWCxjt4AN96lIs+zUBXxZL7ty0pIT7AtSQHgtftxRsDc5+qQfO38CHTsQaSGoorM6fsqH zKb88YD2sw/SYq0opHpHiOeYUzEe1mykDNGcDbICfvbWdB03 X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A The read operation is only used to read fixed data at fixed offsets (UCSI_VERSION, UCSI_CCI, UCSI_MESSAGE_IN). In some cases drivers apply offset-specific overrides. Split the read() operation into three operations, read_version(), read_cci(), read_message_in(). Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 20 ++++----- drivers/usb/typec/ucsi/ucsi.h | 9 +++-- drivers/usb/typec/ucsi/ucsi_acpi.c | 72 ++++++++++++++++++++++++++---= ---- drivers/usb/typec/ucsi/ucsi_ccg.c | 50 ++++++++++++----------- drivers/usb/typec/ucsi/ucsi_glink.c | 19 ++++++++- drivers/usb/typec/ucsi/ucsi_stm32g0.c | 19 ++++++++- drivers/usb/typec/ucsi/ucsi_yoga_c630.c | 52 +++++++++++++++--------- 7 files changed, 169 insertions(+), 72 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index 52903eea7274..db25f51ff71d 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -46,7 +46,7 @@ static int ucsi_read_message_in(struct ucsi *ucsi, void *= buf, if (ucsi->version <=3D UCSI_VERSION_1_2) buf_size =3D clamp(buf_size, 0, 16); =20 - return ucsi->ops->read(ucsi, UCSI_MESSAGE_IN, buf, buf_size); + return ucsi->ops->read_message_in(ucsi, buf, buf_size); } =20 static int ucsi_acknowledge(struct ucsi *ucsi, bool conn_ack) @@ -130,7 +130,7 @@ static int ucsi_exec_command(struct ucsi *ucsi, u64 cmd) if (ret) return ret; =20 - ret =3D ucsi->ops->read(ucsi, UCSI_CCI, &cci, sizeof(cci)); + ret =3D ucsi->ops->read_cci(ucsi, &cci); if (ret) return ret; =20 @@ -1309,7 +1309,7 @@ static int ucsi_reset_ppm(struct ucsi *ucsi) =20 mutex_lock(&ucsi->ppm_lock); =20 - ret =3D ucsi->ops->read(ucsi, UCSI_CCI, &cci, sizeof(cci)); + ret =3D ucsi->ops->read_cci(ucsi, &cci); if (ret < 0) goto out; =20 @@ -1327,8 +1327,7 @@ static int ucsi_reset_ppm(struct ucsi *ucsi) =20 tmo =3D jiffies + msecs_to_jiffies(UCSI_TIMEOUT_MS); do { - ret =3D ucsi->ops->read(ucsi, UCSI_CCI, - &cci, sizeof(cci)); + ret =3D ucsi->ops->read_cci(ucsi, &cci); if (ret < 0) goto out; if (cci & UCSI_CCI_COMMAND_COMPLETE) @@ -1357,7 +1356,7 @@ static int ucsi_reset_ppm(struct ucsi *ucsi) /* Give the PPM time to process a reset before reading CCI */ msleep(20); =20 - ret =3D ucsi->ops->read(ucsi, UCSI_CCI, &cci, sizeof(cci)); + ret =3D ucsi->ops->read_cci(ucsi, &cci); if (ret) goto out; =20 @@ -1777,7 +1776,7 @@ static int ucsi_init(struct ucsi *ucsi) ucsi->ntfy =3D ntfy; =20 mutex_lock(&ucsi->ppm_lock); - ret =3D ucsi->ops->read(ucsi, UCSI_CCI, &cci, sizeof(cci)); + ret =3D ucsi->ops->read_cci(ucsi, &cci); mutex_unlock(&ucsi->ppm_lock); if (ret) return ret; @@ -1891,7 +1890,9 @@ struct ucsi *ucsi_create(struct device *dev, const st= ruct ucsi_operations *ops) { struct ucsi *ucsi; =20 - if (!ops || !ops->read || !ops->sync_control || !ops->async_control) + if (!ops || + !ops->read_version || !ops->read_cci || !ops->read_message_in || + !ops->sync_control || !ops->async_control) return ERR_PTR(-EINVAL); =20 ucsi =3D kzalloc(sizeof(*ucsi), GFP_KERNEL); @@ -1927,8 +1928,7 @@ int ucsi_register(struct ucsi *ucsi) { int ret; =20 - ret =3D ucsi->ops->read(ucsi, UCSI_VERSION, &ucsi->version, - sizeof(ucsi->version)); + ret =3D ucsi->ops->read_version(ucsi, &ucsi->version); if (ret) return ret; =20 diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h index 3ad64acffda1..5c5a8c63090d 100644 --- a/drivers/usb/typec/ucsi/ucsi.h +++ b/drivers/usb/typec/ucsi/ucsi.h @@ -56,7 +56,9 @@ struct dentry; =20 /** * struct ucsi_operations - UCSI I/O operations - * @read: Read operation + * @read_version: Read implemented UCSI version + * @read_cci: Read CCI register + * @read_message_in: Read message data from UCSI * @sync_control: Blocking control operation * @async_control: Non-blocking control operation * @update_altmodes: Squashes duplicate DP altmodes @@ -68,8 +70,9 @@ struct dentry; * return immediately after sending the data to the PPM. */ struct ucsi_operations { - int (*read)(struct ucsi *ucsi, unsigned int offset, - void *val, size_t val_len); + int (*read_version)(struct ucsi *ucsi, u16 *version); + int (*read_cci)(struct ucsi *ucsi, u32 *cci); + int (*read_message_in)(struct ucsi *ucsi, void *val, size_t val_len); int (*sync_control)(struct ucsi *ucsi, u64 command); int (*async_control)(struct ucsi *ucsi, u64 command); bool (*update_altmodes)(struct ucsi *ucsi, struct ucsi_altmode *orig, diff --git a/drivers/usb/typec/ucsi/ucsi_acpi.c b/drivers/usb/typec/ucsi/uc= si_acpi.c index f54e4722d8f6..3660dc3e6d32 100644 --- a/drivers/usb/typec/ucsi/ucsi_acpi.c +++ b/drivers/usb/typec/ucsi/ucsi_acpi.c @@ -46,8 +46,7 @@ static int ucsi_acpi_dsm(struct ucsi_acpi *ua, int func) return 0; } =20 -static int ucsi_acpi_read(struct ucsi *ucsi, unsigned int offset, - void *val, size_t val_len) +static int ucsi_acpi_read_version(struct ucsi *ucsi, u16 *version) { struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); int ret; @@ -56,7 +55,35 @@ static int ucsi_acpi_read(struct ucsi *ucsi, unsigned in= t offset, if (ret) return ret; =20 - memcpy(val, ua->base + offset, val_len); + memcpy(version, ua->base + UCSI_VERSION, sizeof(*version)); + + return 0; +} + +static int ucsi_acpi_read_cci(struct ucsi *ucsi, u32 *cci) +{ + struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); + int ret; + + ret =3D ucsi_acpi_dsm(ua, UCSI_DSM_FUNC_READ); + if (ret) + return ret; + + memcpy(cci, ua->base + UCSI_CCI, sizeof(*cci)); + + return 0; +} + +static int ucsi_acpi_read_message_in(struct ucsi *ucsi, void *val, size_t = val_len) +{ + struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); + int ret; + + ret =3D ucsi_acpi_dsm(ua, UCSI_DSM_FUNC_READ); + if (ret) + return ret; + + memcpy(val, ua->base + UCSI_MESSAGE_IN, val_len); =20 return 0; } @@ -99,36 +126,50 @@ static int ucsi_acpi_sync_control(struct ucsi *ucsi, u= 64 command) } =20 static const struct ucsi_operations ucsi_acpi_ops =3D { - .read =3D ucsi_acpi_read, + .read_version =3D ucsi_acpi_read_version, + .read_cci =3D ucsi_acpi_read_cci, + .read_message_in =3D ucsi_acpi_read_message_in, .sync_control =3D ucsi_acpi_sync_control, .async_control =3D ucsi_acpi_async_control }; =20 static int -ucsi_zenbook_read(struct ucsi *ucsi, unsigned int offset, void *val, size_= t val_len) +ucsi_zenbook_read_cci(struct ucsi *ucsi, u32 *cci) { struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); int ret; =20 - if (offset =3D=3D UCSI_VERSION || UCSI_COMMAND(ua->cmd) =3D=3D UCSI_PPM_R= ESET) { + if (UCSI_COMMAND(ua->cmd) =3D=3D UCSI_PPM_RESET) { ret =3D ucsi_acpi_dsm(ua, UCSI_DSM_FUNC_READ); if (ret) return ret; } =20 - memcpy(val, ua->base + offset, val_len); + memcpy(cci, ua->base + UCSI_CCI, sizeof(*cci)); + + return 0; +} + +static int +ucsi_zenbook_read_message_in(struct ucsi *ucsi, void *val, size_t val_len) +{ + struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); + + /* UCSI_MESSAGE_IN is never read for PPM_RESET, return stored data */ + memcpy(val, ua->base + UCSI_MESSAGE_IN, val_len); =20 return 0; } =20 static const struct ucsi_operations ucsi_zenbook_ops =3D { - .read =3D ucsi_zenbook_read, + .read_version =3D ucsi_acpi_read_version, + .read_cci =3D ucsi_zenbook_read_cci, + .read_message_in =3D ucsi_zenbook_read_message_in, .sync_control =3D ucsi_acpi_sync_control, .async_control =3D ucsi_acpi_async_control }; =20 -static int ucsi_gram_read(struct ucsi *ucsi, unsigned int offset, - void *val, size_t val_len) +static int ucsi_gram_read_message_in(struct ucsi *ucsi, void *val, size_t = val_len) { u16 bogus_change =3D UCSI_CONSTAT_POWER_LEVEL_CHANGE | UCSI_CONSTAT_PDOS_CHANGE; @@ -136,13 +177,12 @@ static int ucsi_gram_read(struct ucsi *ucsi, unsigned= int offset, struct ucsi_connector_status *status; int ret; =20 - ret =3D ucsi_acpi_read(ucsi, offset, val, val_len); + ret =3D ucsi_acpi_read_message_in(ucsi, val, val_len); if (ret < 0) return ret; =20 if (UCSI_COMMAND(ua->cmd) =3D=3D UCSI_GET_CONNECTOR_STATUS && - test_bit(UCSI_ACPI_CHECK_BOGUS_EVENT, &ua->flags) && - offset =3D=3D UCSI_MESSAGE_IN) { + test_bit(UCSI_ACPI_CHECK_BOGUS_EVENT, &ua->flags)) { status =3D (struct ucsi_connector_status *)val; =20 /* Clear the bogus change */ @@ -173,7 +213,9 @@ static int ucsi_gram_sync_control(struct ucsi *ucsi, u6= 4 command) } =20 static const struct ucsi_operations ucsi_gram_ops =3D { - .read =3D ucsi_gram_read, + .read_version =3D ucsi_acpi_read_version, + .read_cci =3D ucsi_acpi_read_cci, + .read_message_in =3D ucsi_gram_read_message_in, .sync_control =3D ucsi_gram_sync_control, .async_control =3D ucsi_acpi_async_control }; @@ -203,7 +245,7 @@ static void ucsi_acpi_notify(acpi_handle handle, u32 ev= ent, void *data) u32 cci; int ret; =20 - ret =3D ua->ucsi->ops->read(ua->ucsi, UCSI_CCI, &cci, sizeof(cci)); + ret =3D ua->ucsi->ops->read_cci(ua->ucsi, &cci); if (ret) return; =20 diff --git a/drivers/usb/typec/ucsi/ucsi_ccg.c b/drivers/usb/typec/ucsi/ucs= i_ccg.c index 76b39bb9762d..6ccc394f268e 100644 --- a/drivers/usb/typec/ucsi/ucsi_ccg.c +++ b/drivers/usb/typec/ucsi/ucsi_ccg.c @@ -556,32 +556,34 @@ static void ucsi_ccg_nvidia_altmode(struct ucsi_ccg *= uc, } } =20 -static int ucsi_ccg_read(struct ucsi *ucsi, unsigned int offset, - void *val, size_t val_len) +static int ucsi_ccg_read_version(struct ucsi *ucsi, u16 *version) { struct ucsi_ccg *uc =3D ucsi_get_drvdata(ucsi); - u16 reg =3D CCGX_RAB_UCSI_DATA_BLOCK(offset); - struct ucsi_capability *cap; - struct ucsi_altmode *alt; - int ret =3D 0; + u16 reg =3D CCGX_RAB_UCSI_DATA_BLOCK(UCSI_VERSION); =20 - if (offset =3D=3D UCSI_CCI) { - spin_lock(&uc->op_lock); - memcpy(val, &(uc->op_data).cci, val_len); - spin_unlock(&uc->op_lock); - } else if (offset =3D=3D UCSI_MESSAGE_IN) { - spin_lock(&uc->op_lock); - memcpy(val, &(uc->op_data).message_in, val_len); - spin_unlock(&uc->op_lock); - } else { - ret =3D ccg_read(uc, reg, val, val_len); - } + return ccg_read(uc, reg, (u8 *)version, sizeof(*version)); +} =20 - if (ret) - return ret; +static int ucsi_ccg_read_cci(struct ucsi *ucsi, u32 *cci) +{ + struct ucsi_ccg *uc =3D ucsi_get_drvdata(ucsi); =20 - if (offset !=3D UCSI_MESSAGE_IN) - return ret; + spin_lock(&uc->op_lock); + *cci =3D uc->op_data.cci; + spin_unlock(&uc->op_lock); + + return 0; +} + +static int ucsi_ccg_read_message_in(struct ucsi *ucsi, void *val, size_t v= al_len) +{ + struct ucsi_ccg *uc =3D ucsi_get_drvdata(ucsi); + struct ucsi_capability *cap; + struct ucsi_altmode *alt; + + spin_lock(&uc->op_lock); + memcpy(val, uc->op_data.message_in, val_len); + spin_unlock(&uc->op_lock); =20 switch (UCSI_COMMAND(uc->last_cmd_sent)) { case UCSI_GET_CURRENT_CAM: @@ -607,7 +609,7 @@ static int ucsi_ccg_read(struct ucsi *ucsi, unsigned in= t offset, } uc->last_cmd_sent =3D 0; =20 - return ret; + return 0; } =20 static int ucsi_ccg_async_control(struct ucsi *ucsi, u64 command) @@ -663,7 +665,9 @@ static int ucsi_ccg_sync_control(struct ucsi *ucsi, u64= command) } =20 static const struct ucsi_operations ucsi_ccg_ops =3D { - .read =3D ucsi_ccg_read, + .read_version =3D ucsi_ccg_read_version, + .read_cci =3D ucsi_ccg_read_cci, + .read_message_in =3D ucsi_ccg_read_message_in, .sync_control =3D ucsi_ccg_sync_control, .async_control =3D ucsi_ccg_async_control, .update_altmodes =3D ucsi_ccg_update_altmodes diff --git a/drivers/usb/typec/ucsi/ucsi_glink.c b/drivers/usb/typec/ucsi/u= csi_glink.c index ebd76257c4fc..56bad054e78f 100644 --- a/drivers/usb/typec/ucsi/ucsi_glink.c +++ b/drivers/usb/typec/ucsi/ucsi_glink.c @@ -114,6 +114,21 @@ static int pmic_glink_ucsi_read(struct ucsi *__ucsi, u= nsigned int offset, return ret; } =20 +static int pmic_glink_ucsi_read_version(struct ucsi *ucsi, u16 *version) +{ + return pmic_glink_ucsi_read(ucsi, UCSI_VERSION, version, sizeof(*version)= ); +} + +static int pmic_glink_ucsi_read_cci(struct ucsi *ucsi, u32 *cci) +{ + return pmic_glink_ucsi_read(ucsi, UCSI_CCI, cci, sizeof(*cci)); +} + +static int pmic_glink_ucsi_read_message_in(struct ucsi *ucsi, void *val, s= ize_t val_len) +{ + return pmic_glink_ucsi_read(ucsi, UCSI_MESSAGE_IN, val, val_len); +} + static int pmic_glink_ucsi_locked_write(struct pmic_glink_ucsi *ucsi, unsi= gned int offset, const void *val, size_t val_len) { @@ -214,7 +229,9 @@ static void pmic_glink_ucsi_connector_status(struct ucs= i_connector *con) } =20 static const struct ucsi_operations pmic_glink_ucsi_ops =3D { - .read =3D pmic_glink_ucsi_read, + .read_version =3D pmic_glink_ucsi_read_version, + .read_cci =3D pmic_glink_ucsi_read_cci, + .read_message_in =3D pmic_glink_ucsi_read_message_in, .sync_control =3D pmic_glink_ucsi_sync_control, .async_control =3D pmic_glink_ucsi_async_control, .update_connector =3D pmic_glink_ucsi_update_connector, diff --git a/drivers/usb/typec/ucsi/ucsi_stm32g0.c b/drivers/usb/typec/ucsi= /ucsi_stm32g0.c index 396e2090e7c3..14737ca3724c 100644 --- a/drivers/usb/typec/ucsi/ucsi_stm32g0.c +++ b/drivers/usb/typec/ucsi/ucsi_stm32g0.c @@ -359,6 +359,21 @@ static int ucsi_stm32g0_read(struct ucsi *ucsi, unsign= ed int offset, void *val, return 0; } =20 +static int ucsi_stm32g0_read_version(struct ucsi *ucsi, u16 *version) +{ + return ucsi_stm32g0_read(ucsi, UCSI_VERSION, version, sizeof(*version)); +} + +static int ucsi_stm32g0_read_cci(struct ucsi *ucsi, u32 *cci) +{ + return ucsi_stm32g0_read(ucsi, UCSI_CCI, cci, sizeof(*cci)); +} + +static int ucsi_stm32g0_read_message_in(struct ucsi *ucsi, void *val, size= _t len) +{ + return ucsi_stm32g0_read(ucsi, UCSI_MESSAGE_IN, val, len); +} + static int ucsi_stm32g0_async_control(struct ucsi *ucsi, u64 command) { struct ucsi_stm32g0 *g0 =3D ucsi_get_drvdata(ucsi); @@ -446,7 +461,9 @@ static irqreturn_t ucsi_stm32g0_irq_handler(int irq, vo= id *data) } =20 static const struct ucsi_operations ucsi_stm32g0_ops =3D { - .read =3D ucsi_stm32g0_read, + .read_version =3D ucsi_stm32g0_read_version, + .read_cci =3D ucsi_stm32g0_read_cci, + .read_message_in =3D ucsi_stm32g0_read_message_in, .sync_control =3D ucsi_stm32g0_sync_control, .async_control =3D ucsi_stm32g0_async_control, }; diff --git a/drivers/usb/typec/ucsi/ucsi_yoga_c630.c b/drivers/usb/typec/uc= si/ucsi_yoga_c630.c index e5e8ba0c0eaa..95a333ad5496 100644 --- a/drivers/usb/typec/ucsi/ucsi_yoga_c630.c +++ b/drivers/usb/typec/ucsi/ucsi_yoga_c630.c @@ -27,8 +27,16 @@ struct yoga_c630_ucsi { u16 version; }; =20 -static int yoga_c630_ucsi_read(struct ucsi *ucsi, unsigned int offset, - void *val, size_t val_len) +static int yoga_c630_ucsi_read_version(struct ucsi *ucsi, u16 *version) +{ + struct yoga_c630_ucsi *uec =3D ucsi_get_drvdata(ucsi); + + *version =3D uec->version; + + return 0; +} + +static int yoga_c630_ucsi_read_cci(struct ucsi *ucsi, u32 *cci) { struct yoga_c630_ucsi *uec =3D ucsi_get_drvdata(ucsi); u8 buf[YOGA_C630_UCSI_READ_SIZE]; @@ -38,22 +46,26 @@ static int yoga_c630_ucsi_read(struct ucsi *ucsi, unsig= ned int offset, if (ret) return ret; =20 - if (offset =3D=3D UCSI_VERSION) { - memcpy(val, &uec->version, min(val_len, sizeof(uec->version))); - return 0; - } + memcpy(cci, buf, sizeof(*cci)); =20 - switch (offset) { - case UCSI_CCI: - memcpy(val, buf, min(val_len, YOGA_C630_UCSI_CCI_SIZE)); - return 0; - case UCSI_MESSAGE_IN: - memcpy(val, buf + YOGA_C630_UCSI_CCI_SIZE, - min(val_len, YOGA_C630_UCSI_DATA_SIZE)); - return 0; - default: - return -EINVAL; - } + return 0; +} + +static int yoga_c630_ucsi_read_message_in(struct ucsi *ucsi, + void *val, size_t val_len) +{ + struct yoga_c630_ucsi *uec =3D ucsi_get_drvdata(ucsi); + u8 buf[YOGA_C630_UCSI_READ_SIZE]; + int ret; + + ret =3D yoga_c630_ec_ucsi_read(uec->ec, buf); + if (ret) + return ret; + + memcpy(val, buf + YOGA_C630_UCSI_CCI_SIZE, + min(val_len, YOGA_C630_UCSI_DATA_SIZE)); + + return 0; } =20 static int yoga_c630_ucsi_async_control(struct ucsi *ucsi, u64 command) @@ -93,7 +105,9 @@ static int yoga_c630_ucsi_sync_control(struct ucsi *ucsi= , u64 command) } =20 const struct ucsi_operations yoga_c630_ucsi_ops =3D { - .read =3D yoga_c630_ucsi_read, + .read_version =3D yoga_c630_ucsi_read_version, + .read_cci =3D yoga_c630_ucsi_read_cci, + .read_message_in =3D yoga_c630_ucsi_read_message_in, .sync_control =3D yoga_c630_ucsi_sync_control, .async_control =3D yoga_c630_ucsi_async_control, }; @@ -126,7 +140,7 @@ static int yoga_c630_ucsi_notify(struct notifier_block = *nb, return NOTIFY_OK; =20 case LENOVO_EC_EVENT_UCSI: - ret =3D uec->ucsi->ops->read(uec->ucsi, UCSI_CCI, &cci, sizeof(cci)); + ret =3D uec->ucsi->ops->read_cci(uec->ucsi, &cci); if (ret) return NOTIFY_DONE; =20 --=20 2.39.2 From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lj1-f171.google.com (mail-lj1-f171.google.com [209.85.208.171]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 2CA8516F85F for ; Tue, 25 Jun 2024 14:54:35 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.208.171 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327277; cv=none; b=TzQIDf5dfz7McVrFtGHmMk1jGf0Lr4aDqoUYEALLTv6G0Xu6WVhSa1MpYeMTANQwiH6CjdoZZCOY73sjnL97Y/XdZ1Xq6oG+CYTUttpGqSrNZiPRjKLi/M97zZC/guM8OoSF6FhhuwtATwN/gCIiX/nWiVtBTSzLEt2VIb3k4M8= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327277; c=relaxed/simple; bh=iGz/1CTodFFLxhp6bKYq0V9qXiKSF7JlfOGZtn0n3AI=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=jNcLEGq0F2z0MsVZYZOxKbSAbVsLZFS8/4SFQfAeG+I2huF2QlqyvEMZRUVMn5GajsJUY0QcdB6PgiCiHGgx4IVwSSbI10O3iSk5xUz3s3i+f7KUsCKss69vrAoUhqtaIpkNqxHniX4Bf/vrIVIbOZMuCUYJvc9ids6qmR4cgRU= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=hiTIGksk; arc=none smtp.client-ip=209.85.208.171 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="hiTIGksk" Received: by mail-lj1-f171.google.com with SMTP id 38308e7fff4ca-2ec52fbb50aso40577761fa.3 for ; Tue, 25 Jun 2024 07:54:34 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327273; x=1719932073; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=+KB8pq5NQAZ6n/rTI4y8OIrQXRuJ/BDLkN3YelnKCzI=; b=hiTIGksk89zMJUFJnB69SRRfhUbMnTHFX5+Yg1/cEyLcRyaW97rCBBBAnNnapjclLN qBzm3ROHVVdo1orBXXhyXeleF6CFYR8TA+88uaRj85QUGDFLKH3HrKOL5NI9WCXPh7Se qrViRtkI4MeA+BJYjbqHTJbcwtMdQdiE2hzI/NRyWxR01RNuZ/S/8RhlbVYhC/YRjMeW ekUDI0/QxqESOSaAuJSkQgvSHUUZ23x96kjXkh1q8VH0Xj7tKPaNOWZw1HJebbpzFEps JArub/0sUfzQVmY+OkXuQ218nMqSatf3PPvyX4cmY0y3SN3ech8ZPr7Pm00VRvppf8wt fFbw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327273; x=1719932073; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=+KB8pq5NQAZ6n/rTI4y8OIrQXRuJ/BDLkN3YelnKCzI=; b=cTOWh2HRycBTOUswPAVnwSApv1JDFxjvkf2sybZkn1DeqFolBa2bAf439g/nrJ9/IC HHQZifQOtt9qeFfwdlYOUM08RvjW2ni5BEi8xb8S32zpy5MzYATmGheiLy4fxuK5FKQF acQSmoRDfZRenNrR/aUiPekmnxRKka3z5ufzSvY4ur12Rpl+W8RvesHqA//c4NJftohG 4p+rJP5fQoN8v7EikfSl6iTBZaXF+9EaF7n9JpKd+cnH0QAyvwNHlxXClg5VIcSj5K6e ehGu7hV79sRUfwE5/z39etCpfy1b5KhcgwIVxAXsRqu9zKoIC9K+S3W/fI0USIkAkCoN K/EQ== X-Forwarded-Encrypted: i=1; AJvYcCXF3uqqMUSzyamvg7YZdK4eN2ys/iGbyIkX/xwo9UueVRpzspilVJs9hgBIuWsQ8rPsEnjqn/8fY5glN+MHkAdjl2K91wzwj1oGmc8D X-Gm-Message-State: AOJu0YwI/JZQ0hX5o7FC76N3tgjrzqOKDXKPR7W76ZdnnqxMS3JmIJwB otQ8IMb/02P9Rrwm0NPZPe3RS9qsiqQkVtBTI7jqjQtsU2R39sHuyw3nUftEesFob64jg8cdnFN FeMQ= X-Google-Smtp-Source: AGHT+IGtQxo5jV6cMwfXqOOOPD8YZNEebt3pWP+GVzXLpNydBk0U1gGSF/EvGWsWZGvWy6VumzOMyA== X-Received: by 2002:ac2:58f4:0:b0:52c:dacf:e5ac with SMTP id 2adb3069b0e04-52ce185d218mr5415211e87.54.1719327273412; Tue, 25 Jun 2024 07:54:33 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.32 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:32 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:29 +0300 Subject: [PATCH v3 4/7] usb: typec: ucsi: rework command execution functions Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-4-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=4449; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=iGz/1CTodFFLxhp6bKYq0V9qXiKSF7JlfOGZtn0n3AI=; b=owEBbQGS/pANAwAKAYs8ij4CKSjVAcsmYgBmetojsGNpr741Om5LXvH7sB4VKPc9Jwl3kjr86 7L8QXP96iqJATMEAAEKAB0WIQRMcISVXLJjVvC4lX+LPIo+Aiko1QUCZnraIwAKCRCLPIo+Aiko 1WCzCACcWhUjxOL5ffytSZW+F/ypklLcxsDF6YxBlJcdE7up+io2SCqomp/iKmX+5dY/ORLmd66 lJuECdbPx9ngWe/pTO+CJNJYrH/dMWh81YM5i2PFb8n73II9/yqhxJmdrhlsw2LgK7If03UgJ2+ k+iO+dPgvCxceKi4Y0cN36dzDSztbdn1k2lHng2/DUhrTuUPscI8g120u9GusllZQ+D8YZjhBuo rUBkA3HL1EDs5Z0URtChJIRQ7i6Vots9o3vGO35gdat2BHFsIzzFeHrLvwp8vV5bQ0mLZVCxQ95 jS/FEKz7Q4a/a0K7/6AjoUN9hZ3Uf0r86rV6mYKJDAiL2jh5 X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A Rework command execution code to remove recursive calls of ucsi_exec_command. This also streamlines the sync_control / read(CCI) read (MESSAGE_IN) sequence, allowing further rework of the command code. Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 134 ++++++++++++++++++++------------------= ---- 1 file changed, 64 insertions(+), 70 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index db25f51ff71d..5f8e5ed9e0f9 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -63,25 +63,74 @@ static int ucsi_acknowledge(struct ucsi *ucsi, bool con= n_ack) return ucsi->ops->sync_control(ucsi, ctrl); } =20 -static int ucsi_exec_command(struct ucsi *ucsi, u64 command); - -static int ucsi_read_error(struct ucsi *ucsi) +static int ucsi_run_command(struct ucsi *ucsi, u64 command, u32 *cci, + void *data, size_t size, bool conn_ack) { - u16 error; int ret; =20 - ret =3D ucsi_exec_command(ucsi, UCSI_GET_ERROR_STATUS); - if (ret < 0) + *cci =3D 0; + + ret =3D ucsi->ops->sync_control(ucsi, command); + if (ret) return ret; =20 - ret =3D ucsi_read_message_in(ucsi, &error, sizeof(error)); + ret =3D ucsi->ops->read_cci(ucsi, cci); if (ret) return ret; =20 - ret =3D ucsi_acknowledge(ucsi, false); + if (*cci & UCSI_CCI_BUSY) + return -EBUSY; + + if (!(*cci & UCSI_CCI_COMMAND_COMPLETE)) + return -EIO; + + if (*cci & UCSI_CCI_NOT_SUPPORTED) { + if (ucsi_acknowledge(ucsi, false) < 0) + dev_err(ucsi->dev, + "ACK of unsupported command failed\n"); + return -EOPNOTSUPP; + } + + if (*cci & UCSI_CCI_ERROR) { + /* Acknowledge the command that failed */ + ret =3D ucsi_acknowledge(ucsi, false); + return ret ? ret : -EIO; + } + + if (data) { + ret =3D ucsi_read_message_in(ucsi, data, size); + if (ret) + return ret; + } + + ret =3D ucsi_acknowledge(ucsi, conn_ack); if (ret) return ret; =20 + return 0; +} + +static int ucsi_read_error(struct ucsi *ucsi) +{ + u16 error; + u32 cci; + int ret; + + ret =3D ucsi_run_command(ucsi, UCSI_GET_ERROR_STATUS, &cci, + &error, sizeof(error), false); + + if (cci & UCSI_CCI_BUSY) { + ret =3D ucsi_run_command(ucsi, UCSI_CANCEL, &cci, NULL, 0, false); + + return ret ? ret : -EBUSY; + } + + if (ret < 0) + return ret; + + if (cci & UCSI_CCI_ERROR) + return -EIO; + switch (error) { case UCSI_ERROR_INCOMPATIBLE_PARTNER: return -EOPNOTSUPP; @@ -121,78 +170,23 @@ static int ucsi_read_error(struct ucsi *ucsi) return -EIO; } =20 -static int ucsi_exec_command(struct ucsi *ucsi, u64 cmd) -{ - u32 cci; - int ret; - - ret =3D ucsi->ops->sync_control(ucsi, cmd); - if (ret) - return ret; - - ret =3D ucsi->ops->read_cci(ucsi, &cci); - if (ret) - return ret; - - if (cmd !=3D UCSI_CANCEL && cci & UCSI_CCI_BUSY) - return ucsi_exec_command(ucsi, UCSI_CANCEL); - - if (!(cci & UCSI_CCI_COMMAND_COMPLETE)) - return -EIO; - - if (cci & UCSI_CCI_NOT_SUPPORTED) { - if (ucsi_acknowledge(ucsi, false) < 0) - dev_err(ucsi->dev, - "ACK of unsupported command failed\n"); - return -EOPNOTSUPP; - } - - if (cci & UCSI_CCI_ERROR) { - /* Acknowledge the command that failed */ - ret =3D ucsi_acknowledge(ucsi, false); - if (ret) - return ret; - - if (cmd =3D=3D UCSI_GET_ERROR_STATUS) - return -EIO; - - return ucsi_read_error(ucsi); - } - - if (cmd =3D=3D UCSI_CANCEL && cci & UCSI_CCI_CANCEL_COMPLETE) { - ret =3D ucsi_acknowledge(ucsi, false); - return ret ? ret : -EBUSY; - } - - return UCSI_CCI_LENGTH(cci); -} - static int ucsi_send_command_common(struct ucsi *ucsi, u64 command, void *data, size_t size, bool conn_ack) { - u8 length; + u32 cci; int ret; =20 mutex_lock(&ucsi->ppm_lock); =20 - ret =3D ucsi_exec_command(ucsi, command); - if (ret < 0) - goto out; - - length =3D ret; - - if (data) { - ret =3D ucsi_read_message_in(ucsi, data, size); - if (ret) - goto out; + ret =3D ucsi_run_command(ucsi, command, &cci, data, size, conn_ack); + if (cci & UCSI_CCI_BUSY) { + ret =3D ucsi_run_command(ucsi, UCSI_CANCEL, &cci, NULL, 0, false); + return ret ? ret : -EBUSY; } =20 - ret =3D ucsi_acknowledge(ucsi, conn_ack); - if (ret) - goto out; + if (cci & UCSI_CCI_ERROR) + return ucsi_read_error(ucsi); =20 - ret =3D length; -out: mutex_unlock(&ucsi->ppm_lock); return ret; } --=20 2.39.2 From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lf1-f43.google.com (mail-lf1-f43.google.com [209.85.167.43]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id CD7A116DEBA for ; Tue, 25 Jun 2024 14:54:35 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.167.43 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327278; cv=none; b=d3l8oH7NFcCsrrrePCA6353oR5NQ8HhA4LfC6BMY/Yy3pp6+Lj8ridO+xzOWqEcwEEdpCbgOSMi/QMH1wPJ9r/S843pewdtBhcxG4x7uj8NZYl0lfXf2SioHQtSG9iobes7spXYtDQmgeM+68cXAyc+plV/1OEl40FIZP+4wAuU= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327278; c=relaxed/simple; bh=mI5j32lGmh9mGgx/qR0lTHll3MYLBaGs+ozW531l430=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=sDhl/kZ0kouOA1dGS/0lH3ZYyf8rrb+JKpZaqxHJ7K5kMbyUBkJpGZm45QKVu4SaY4gYY6WidEyCy//FPNzbh5iT8vayNBiXaUqfgkJ/aIJVimPGh27rnQjH4g6THtjTKr6VsFT7f4fqZi6JFT3bVNFaIAlKiHgagP0bEq1dD+E= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=oJJE5Buv; arc=none smtp.client-ip=209.85.167.43 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="oJJE5Buv" Received: by mail-lf1-f43.google.com with SMTP id 2adb3069b0e04-52cd628f21cso4817286e87.3 for ; Tue, 25 Jun 2024 07:54:35 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327274; x=1719932074; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=Cd2X10zVjMn+EpTL9h3lm0rs/LnmaQV9sjYCW3W4aNs=; b=oJJE5BuvahRP12naSnUVYs4rslHdKo4HnnqhN73N4g6GDK2lxvJ9HdM6q6SrN/XMQy i8Bj9dJtlESIzpniA6Y+1R0jzXkcKi5pfI5aKm265ItfIZh8U0uSwUtgmx5P/lbR01Ou lTKblWXAXqvpfPC+Np6ee5TxjoVpWfai+9n4lQECZ+75TYSHwAn08FxPhUCEhmIanuOm H87ZtthKNM5KnjXUJ7mYk0tnTP31OMYGtDoHaiXEmS0gsYdZizl8BVAXKimJTtRVrWnN fHj8bzQPMiDeK6Zo73ki3FwYZV/1IomZAam1L5rd+bdJmnYCWpGJ0dvFf9UHfpzVl3mb Y0Xw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327274; x=1719932074; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=Cd2X10zVjMn+EpTL9h3lm0rs/LnmaQV9sjYCW3W4aNs=; b=EHgnr2d79Oc9SRqWaxCycuvA2JnFLG0173mL7yUJR5gdrzIV59DuOFW3sKbNLAhYcE KchzWeNchNqcEeC20X4ysvnSxrZzMI4qXmYAJlabwMlgmCfWQ0KSMhoyMWIBQJXbuuqD /0wtBmdFDqKEjR/mtKbzqWnnMcUx/aYpMY1vs1042//2d7OVC3detrgwN4M0BXketqqZ go/LtJt2ArcYmSa06eNOl5HiOX5WC8rusOwL9UB5O3dlhFjJWFMQs4PoPmR0ILImuXii vnARQP5SLtfLMET9Qfuj7UrFOGajhwlUd85xycfNmMKYXweog48uXwjejwRFMNsCs+RB uCAw== X-Forwarded-Encrypted: i=1; AJvYcCV5XIfAbU+Y5NaEMiEkOKuk5OD8RWlMtd9wOvCLwnUI7drHVWr3utDNgyueS7WpmGqcTi4K3Ka5XDtLjfajCJpyLUrlAmimhSwgczve X-Gm-Message-State: AOJu0YxwvrJf6oI5vNRZVKBdTm7IIP+WgmFchD8JR8yr8jBMnbNEpJbL NKwvxJXsNlVJOqmx5EA8sWVx2Ze+C0pVjT9Bgg4AdoV/J5gHvhd2rUkdrxBF98Q= X-Google-Smtp-Source: AGHT+IFBU/FqlV1rlHFm7VcDP7TI1En+d6tYg9faOguYFxQeaenBL0P/drueNcNZbM5bdmNqJCDT6w== X-Received: by 2002:a05:6512:2394:b0:52c:d84c:1182 with SMTP id 2adb3069b0e04-52ce1862c12mr5311099e87.64.1719327274126; Tue, 25 Jun 2024 07:54:34 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.33 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:33 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:30 +0300 Subject: [PATCH v3 5/7] usb: typec: ucsi: inline ucsi_read_message_in Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-5-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=1606; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=mI5j32lGmh9mGgx/qR0lTHll3MYLBaGs+ozW531l430=; b=owEBbQGS/pANAwAKAYs8ij4CKSjVAcsmYgBmetojhmAknU4eETQ/0OVEnR93dwpzXwqv4zv11 DBDhLbs1XGJATMEAAEKAB0WIQRMcISVXLJjVvC4lX+LPIo+Aiko1QUCZnraIwAKCRCLPIo+Aiko 1Zv3B/9UujGkolgkJQLF8DrUxTo7LuRVr+QOZJVWx5Y+Qqj2Vrktn20TdD10r17dEMR4lI7w1VC UMrX64IlrvWdR72wijPKPH6uafW5wUnCh3PNSBQgh+/03iBS8LwLJHaACH8JzISR8VnV8dh6Cya Xn2x+c9iwslIG6VPuSj+cxfyP1RPp+XY24Um3N7VOqS9MpeuJ54FtBQ9SwcEq/lf33MRf/+Vxv+ WwdlSitm/UoP2YJG99Fmg4nhaSNFDyyuKOvwrwC8TVZlSnhgehx4ekDRPW/4pQEtyC2R6/PNpN5 9FXIu8GWZ1DIn1Pb30kNSGbmuqxjMWkVwcYgoe6MFIjYwGMf X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A There is no need to have a separate wrapper for reading MESSAGE_IN data, inline it to ucsi_run_command(). Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 22 ++++++++-------------- 1 file changed, 8 insertions(+), 14 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index 5f8e5ed9e0f9..e14366e20cd5 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -36,19 +36,6 @@ */ #define UCSI_SWAP_TIMEOUT_MS 5000 =20 -static int ucsi_read_message_in(struct ucsi *ucsi, void *buf, - size_t buf_size) -{ - /* - * Below UCSI 2.0, MESSAGE_IN was limited to 16 bytes. Truncate the - * reads here. - */ - if (ucsi->version <=3D UCSI_VERSION_1_2) - buf_size =3D clamp(buf_size, 0, 16); - - return ucsi->ops->read_message_in(ucsi, buf, buf_size); -} - static int ucsi_acknowledge(struct ucsi *ucsi, bool conn_ack) { u64 ctrl; @@ -70,6 +57,13 @@ static int ucsi_run_command(struct ucsi *ucsi, u64 comma= nd, u32 *cci, =20 *cci =3D 0; =20 + /* + * Below UCSI 2.0, MESSAGE_IN was limited to 16 bytes. Truncate the + * reads here. + */ + if (ucsi->version <=3D UCSI_VERSION_1_2) + size =3D clamp(size, 0, 16); + ret =3D ucsi->ops->sync_control(ucsi, command); if (ret) return ret; @@ -98,7 +92,7 @@ static int ucsi_run_command(struct ucsi *ucsi, u64 comman= d, u32 *cci, } =20 if (data) { - ret =3D ucsi_read_message_in(ucsi, data, size); + ret =3D ucsi->ops->read_message_in(ucsi, data, size); if (ret) return ret; } --=20 2.39.2 From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lf1-f41.google.com (mail-lf1-f41.google.com [209.85.167.41]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id A905516F918 for ; Tue, 25 Jun 2024 14:54:36 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.167.41 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327279; cv=none; b=kH0uDobXr5MIPJZsc2Js1MJoDBbW7hbuGGAOAR3wSrr9pd8Tb6hfo4bfSveu88YzYGQ+ESiEIRGN8/aLrn0YPqdlvcduHQny9t6MfyDnXtsdIwzqpiBsxsulQsNlxbgH9jbloLjVUiKWi43MnUQt+N6TrLGx8XXxvF/4otxS+CU= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327279; c=relaxed/simple; bh=cnfB8S/RXo/ZEWQY0rQqmDwr4D3dCufkp0JaUwPvn/I=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=L63Tb6X5sLBN6TutBgrHsIKChA4GJxUQjo+A7R7S6aRVQ+TZri5D8/voq11woaIJOw+cO2bTbnwWB7gMnVAUqvicsg0HxrFbrfrISfyawx+r1sb27kk5Aj2cD4PgqrRwMr03vLhu0l7KUR2OJw0wnDXsqLrvI8x60FwNpTvh/Ac= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=MUzLGaVC; arc=none smtp.client-ip=209.85.167.41 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="MUzLGaVC" Received: by mail-lf1-f41.google.com with SMTP id 2adb3069b0e04-52caebc6137so5321751e87.0 for ; Tue, 25 Jun 2024 07:54:36 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327275; x=1719932075; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=S5qhm4+2XkcMwcHH9Y62ZxdXLR2b03l5U4e9I0TRazQ=; b=MUzLGaVCLZH8wXIFFr3TF8XGkQdOpB3+My/e2EIljQ62I3pPIJkYPC5eoa8H0288mI WrmJK6B2ULRkRw+tAIDDRFbQX/mEuuMg5C4oMd9mXFQP4I9la7DaG1U2XMu8GrfzHj+3 VIqkVnc05m+BF9Ogt6N3VSiodsM/SLh1h9zy/75ExMtAeiDTYjWXlhjMyxBCgVZUBID/ XD+xYdTgNweQp9ttZEMPFCh5pJaXPLImMsQDOFoCKqKuXhuCKBF4CIupmHD7kUdvzykb mogdyu6bj2GO6tfkH7uAiChFdVTmw3eJg8hogOaBgc/8HixHCPESCGHvpDkuBcNl5prk 3wdQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327275; x=1719932075; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=S5qhm4+2XkcMwcHH9Y62ZxdXLR2b03l5U4e9I0TRazQ=; b=DR9gjBT/sJmYEmBTQlBfTEVNwlj/LAJV125nE+Qasj9bk4zrBAOBITljdsT1AmH0PF M8ZxFMNY4Af4t3BhtNWQjRqczfrUPtCG30OKNuXMdaWZTJVMql+zQzlebYTvj6Qbd93g Mo5IHyqHqqyaSYtGUycDsDMUt+H9FOuaLCbcuBTM621cjFCiZr+K9/ZW6L0+SqT0jAh6 3wuBvr0bpZFPDcSHs6JWKcF7qydXaN6E4wia+gjjE28FAEhyrP/U5fMPdKZ+A0jlFIn0 GDBnHjdMVGBYC4zOJ86nM69WYlk4FjiAwv03wbzLabVga2FjZT03uJ9Igqi2SWkf60mr 6+XA== X-Forwarded-Encrypted: i=1; AJvYcCWP2JfvUBXa7XqCIdxzO+HIA33bXE2PST6xxRxub6jJ9tQOwqj21F2ecgCXJzBkIRro7bP2t4MNkXtLzYnB81/YMaREQeeAzL099o/A X-Gm-Message-State: AOJu0YzHxigqu4mmbVOU9U2hVmtue2nTykjJ0FiifXjGL0AAI3bbP448 ku43QTLlVK8ZCAorWTGB5TnhTIces5tsbhjGUqGUjosjQHLkcN92QKeLYEJjI94= X-Google-Smtp-Source: AGHT+IEN2LCltJtpjekLEgpKoh8HPCN8iGxEnXstAl9tdb7NmU7VHYkWiqLNDTtNBus6TlrGoWmBMg== X-Received: by 2002:ac2:546f:0:b0:52c:db53:5fe5 with SMTP id 2adb3069b0e04-52ce18351c2mr4404918e87.27.1719327274857; Tue, 25 Jun 2024 07:54:34 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.34 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:34 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:31 +0300 Subject: [PATCH v3 6/7] usb: typec: ucsi: extract common code for command handling Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-6-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=18645; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=cnfB8S/RXo/ZEWQY0rQqmDwr4D3dCufkp0JaUwPvn/I=; b=owGbwMvMwMXYbdNlx6SpcZXxtFoSQ1rVLZVjThMXZViGzgjS3SfVsv4s99eGI/3/uav2BC1sL i036dPpZDRmYWDkYpAVU2TxKWiZGrMpOezDjqn1MINYmUCmMHBxCsBEIhLY/ylW58VedJZYs3TJ QX2blRYMPn+npZrf63Bk8RAIdt6Qe1uGKeOetOMrpsurZf/MdG6JiV4w6+9ff0bWy0qXFA/Jv05 59ydt6Y2f7+R/H768sL26bqbpv69agYHuGXMdN6ZrGOWVqbcsDFneFOqVEftSh0/ZcM0RZaHHba EXlj1sOyX8wHfnxNiAVINuxtdGyg4bLifG8kW66u7bLbN0sc4Xta5tS8rFP/EvcPrBNjHyiEVtJ IOPrK+UwcL07e+2fJjM3ac+o3fe+dWPXKbUHUwtv8gfefl0wvlgKYW8qGCdze5HIi/W1Z/XOiHf k8gQce2ZmYLLK4Pla//xOISFdfTMN1tzx1TQRUZ5gnY2AA== X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A Extract common functions to handle command sending and to handle events from UCSI. This ensures that all UCSI glue drivers handle the ACKs in the same way. The CCG driver used DEV_CMD_PENDING both for internal firmware-related commands and for UCSI control handling. Leave the former use case intact. Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 43 +++++++++++++++++++++++++ drivers/usb/typec/ucsi/ucsi.h | 7 +++++ drivers/usb/typec/ucsi/ucsi_acpi.c | 56 +++++------------------------= ---- drivers/usb/typec/ucsi/ucsi_ccg.c | 21 ++----------- drivers/usb/typec/ucsi/ucsi_glink.c | 47 ++------------------------- drivers/usb/typec/ucsi/ucsi_stm32g0.c | 44 ++------------------------ drivers/usb/typec/ucsi/ucsi_yoga_c630.c | 52 ++---------------------------- 7 files changed, 67 insertions(+), 203 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index e14366e20cd5..3fb5d3a52b80 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -36,6 +36,48 @@ */ #define UCSI_SWAP_TIMEOUT_MS 5000 =20 +void ucsi_notify_common(struct ucsi *ucsi, u32 cci) +{ + if (UCSI_CCI_CONNECTOR(cci)) + ucsi_connector_change(ucsi, UCSI_CCI_CONNECTOR(cci)); + + if (cci & UCSI_CCI_ACK_COMPLETE && + test_bit(ACK_PENDING, &ucsi->flags)) + complete(&ucsi->complete); + + if (cci & UCSI_CCI_COMMAND_COMPLETE && + test_bit(COMMAND_PENDING, &ucsi->flags)) + complete(&ucsi->complete); +} +EXPORT_SYMBOL_GPL(ucsi_notify_common); + +int ucsi_sync_control_common(struct ucsi *ucsi, u64 command) +{ + bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; + int ret; + + if (ack) + set_bit(ACK_PENDING, &ucsi->flags); + else + set_bit(COMMAND_PENDING, &ucsi->flags); + + ret =3D ucsi->ops->async_control(ucsi, command); + if (ret) + goto out_clear_bit; + + if (!wait_for_completion_timeout(&ucsi->complete, 5 * HZ)) + ret =3D -ETIMEDOUT; + +out_clear_bit: + if (ack) + clear_bit(ACK_PENDING, &ucsi->flags); + else + clear_bit(COMMAND_PENDING, &ucsi->flags); + + return ret; +} +EXPORT_SYMBOL_GPL(ucsi_sync_control_common); + static int ucsi_acknowledge(struct ucsi *ucsi, bool conn_ack) { u64 ctrl; @@ -1890,6 +1932,7 @@ struct ucsi *ucsi_create(struct device *dev, const st= ruct ucsi_operations *ops) INIT_WORK(&ucsi->resume_work, ucsi_resume_work); INIT_DELAYED_WORK(&ucsi->work, ucsi_init_work); mutex_init(&ucsi->ppm_lock); + init_completion(&ucsi->complete); ucsi->dev =3D dev; ucsi->ops =3D ops; =20 diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h index 5c5a8c63090d..21ed0eb5be9f 100644 --- a/drivers/usb/typec/ucsi/ucsi.h +++ b/drivers/usb/typec/ucsi/ucsi.h @@ -4,6 +4,7 @@ #define __DRIVER_USB_TYPEC_UCSI_H =20 #include +#include #include #include #include @@ -420,6 +421,9 @@ struct ucsi { /* PPM communication flags */ unsigned long flags; #define EVENT_PENDING 0 +#define COMMAND_PENDING 1 +#define ACK_PENDING 2 + struct completion complete; =20 unsigned long quirks; #define UCSI_NO_PARTNER_PDOS BIT(0) /* Don't read partner's PDOs */ @@ -484,6 +488,9 @@ int ucsi_send_command(struct ucsi *ucsi, u64 command, void ucsi_altmode_update_active(struct ucsi_connector *con); int ucsi_resume(struct ucsi *ucsi); =20 +void ucsi_notify_common(struct ucsi *ucsi, u32 cci); +int ucsi_sync_control_common(struct ucsi *ucsi, u64 command); + #if IS_ENABLED(CONFIG_POWER_SUPPLY) int ucsi_register_port_psy(struct ucsi_connector *con); void ucsi_unregister_port_psy(struct ucsi_connector *con); diff --git a/drivers/usb/typec/ucsi/ucsi_acpi.c b/drivers/usb/typec/ucsi/uc= si_acpi.c index 3660dc3e6d32..7a5dff8d9cc6 100644 --- a/drivers/usb/typec/ucsi/ucsi_acpi.c +++ b/drivers/usb/typec/ucsi/ucsi_acpi.c @@ -21,11 +21,7 @@ struct ucsi_acpi { struct device *dev; struct ucsi *ucsi; void *base; - struct completion complete; - unsigned long flags; -#define UCSI_ACPI_COMMAND_PENDING 1 -#define UCSI_ACPI_ACK_PENDING 2 -#define UCSI_ACPI_CHECK_BOGUS_EVENT 3 + bool check_bogus_event; guid_t guid; u64 cmd; }; @@ -98,38 +94,11 @@ static int ucsi_acpi_async_control(struct ucsi *ucsi, u= 64 command) return ucsi_acpi_dsm(ua, UCSI_DSM_FUNC_WRITE); } =20 -static int ucsi_acpi_sync_control(struct ucsi *ucsi, u64 command) -{ - struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); - bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; - int ret; - - if (ack) - set_bit(UCSI_ACPI_ACK_PENDING, &ua->flags); - else - set_bit(UCSI_ACPI_COMMAND_PENDING, &ua->flags); - - ret =3D ucsi_acpi_async_control(ucsi, command); - if (ret) - goto out_clear_bit; - - if (!wait_for_completion_timeout(&ua->complete, 5 * HZ)) - ret =3D -ETIMEDOUT; - -out_clear_bit: - if (ack) - clear_bit(UCSI_ACPI_ACK_PENDING, &ua->flags); - else - clear_bit(UCSI_ACPI_COMMAND_PENDING, &ua->flags); - - return ret; -} - static const struct ucsi_operations ucsi_acpi_ops =3D { .read_version =3D ucsi_acpi_read_version, .read_cci =3D ucsi_acpi_read_cci, .read_message_in =3D ucsi_acpi_read_message_in, - .sync_control =3D ucsi_acpi_sync_control, + .sync_control =3D ucsi_sync_control_common, .async_control =3D ucsi_acpi_async_control }; =20 @@ -165,7 +134,7 @@ static const struct ucsi_operations ucsi_zenbook_ops = =3D { .read_version =3D ucsi_acpi_read_version, .read_cci =3D ucsi_zenbook_read_cci, .read_message_in =3D ucsi_zenbook_read_message_in, - .sync_control =3D ucsi_acpi_sync_control, + .sync_control =3D ucsi_sync_control_common, .async_control =3D ucsi_acpi_async_control }; =20 @@ -182,14 +151,14 @@ static int ucsi_gram_read_message_in(struct ucsi *ucs= i, void *val, size_t val_le return ret; =20 if (UCSI_COMMAND(ua->cmd) =3D=3D UCSI_GET_CONNECTOR_STATUS && - test_bit(UCSI_ACPI_CHECK_BOGUS_EVENT, &ua->flags)) { + ua->check_bogus_event) { status =3D (struct ucsi_connector_status *)val; =20 /* Clear the bogus change */ if (status->change =3D=3D bogus_change) status->change =3D 0; =20 - clear_bit(UCSI_ACPI_CHECK_BOGUS_EVENT, &ua->flags); + ua->check_bogus_event =3D false; } =20 return ret; @@ -200,14 +169,14 @@ static int ucsi_gram_sync_control(struct ucsi *ucsi, = u64 command) struct ucsi_acpi *ua =3D ucsi_get_drvdata(ucsi); int ret; =20 - ret =3D ucsi_acpi_sync_control(ucsi, command); + ret =3D ucsi_sync_control_common(ucsi, command); if (ret < 0) return ret; =20 if (UCSI_COMMAND(ua->cmd) =3D=3D UCSI_GET_PDOS && ua->cmd & UCSI_GET_PDOS_PARTNER_PDO(1) && ua->cmd & UCSI_GET_PDOS_SRC_PDOS) - set_bit(UCSI_ACPI_CHECK_BOGUS_EVENT, &ua->flags); + ua->check_bogus_event =3D true; =20 return ret; } @@ -249,15 +218,7 @@ static void ucsi_acpi_notify(acpi_handle handle, u32 e= vent, void *data) if (ret) return; =20 - if (UCSI_CCI_CONNECTOR(cci)) - ucsi_connector_change(ua->ucsi, UCSI_CCI_CONNECTOR(cci)); - - if (cci & UCSI_CCI_ACK_COMPLETE && - test_bit(UCSI_ACPI_ACK_PENDING, &ua->flags)) - complete(&ua->complete); - if (cci & UCSI_CCI_COMMAND_COMPLETE && - test_bit(UCSI_ACPI_COMMAND_PENDING, &ua->flags)) - complete(&ua->complete); + ucsi_notify_common(ua->ucsi, cci); } =20 static int ucsi_acpi_probe(struct platform_device *pdev) @@ -291,7 +252,6 @@ static int ucsi_acpi_probe(struct platform_device *pdev) if (ret) return ret; =20 - init_completion(&ua->complete); ua->dev =3D &pdev->dev; =20 id =3D dmi_first_match(ucsi_acpi_quirks); diff --git a/drivers/usb/typec/ucsi/ucsi_ccg.c b/drivers/usb/typec/ucsi/ucs= i_ccg.c index 6ccc394f268e..ba4db2310a05 100644 --- a/drivers/usb/typec/ucsi/ucsi_ccg.c +++ b/drivers/usb/typec/ucsi/ucsi_ccg.c @@ -222,8 +222,6 @@ struct ucsi_ccg { u16 fw_build; struct work_struct pm_work; =20 - struct completion complete; - u64 last_cmd_sent; bool has_multiple_dp; struct ucsi_ccg_altmode orig[UCSI_MAX_ALTMODES]; @@ -637,7 +635,6 @@ static int ucsi_ccg_sync_control(struct ucsi *ucsi, u64= command) =20 mutex_lock(&uc->lock); pm_runtime_get_sync(uc->dev); - set_bit(DEV_CMD_PENDING, &uc->flags); =20 uc->last_cmd_sent =3D command; =20 @@ -649,15 +646,8 @@ static int ucsi_ccg_sync_control(struct ucsi *ucsi, u6= 4 command) ucsi_ccg_update_set_new_cam_cmd(uc, con, &command); } =20 - ret =3D ucsi_ccg_async_control(ucsi, command); - if (ret) - goto err_clear_bit; - - if (!wait_for_completion_timeout(&uc->complete, msecs_to_jiffies(5000))) - ret =3D -ETIMEDOUT; + ret =3D ucsi_sync_control_common(ucsi, command); =20 -err_clear_bit: - clear_bit(DEV_CMD_PENDING, &uc->flags); pm_runtime_put_sync(uc->dev); mutex_unlock(&uc->lock); =20 @@ -694,9 +684,6 @@ static irqreturn_t ccg_irq_handler(int irq, void *data) if (ret) goto err_clear_irq; =20 - if (UCSI_CCI_CONNECTOR(cci)) - ucsi_connector_change(uc->ucsi, UCSI_CCI_CONNECTOR(cci)); - /* * As per CCGx UCSI interface guide, copy CCI and MESSAGE_IN * to the OpRegion before clear the UCSI interrupt @@ -708,9 +695,8 @@ static irqreturn_t ccg_irq_handler(int irq, void *data) err_clear_irq: ccg_write(uc, CCGX_RAB_INTR_REG, &intr_reg, sizeof(intr_reg)); =20 - if (!ret && test_bit(DEV_CMD_PENDING, &uc->flags) && - cci & (UCSI_CCI_ACK_COMPLETE | UCSI_CCI_COMMAND_COMPLETE)) - complete(&uc->complete); + if (!ret) + ucsi_notify_common(uc->ucsi, cci); =20 return IRQ_HANDLED; } @@ -1429,7 +1415,6 @@ static int ucsi_ccg_probe(struct i2c_client *client) uc->client =3D client; uc->irq =3D client->irq; mutex_init(&uc->lock); - init_completion(&uc->complete); INIT_WORK(&uc->work, ccg_update_firmware); INIT_WORK(&uc->pm_work, ccg_pm_workaround_work); =20 diff --git a/drivers/usb/typec/ucsi/ucsi_glink.c b/drivers/usb/typec/ucsi/u= csi_glink.c index 56bad054e78f..16c328497e0b 100644 --- a/drivers/usb/typec/ucsi/ucsi_glink.c +++ b/drivers/usb/typec/ucsi/ucsi_glink.c @@ -64,12 +64,8 @@ struct pmic_glink_ucsi { struct ucsi *ucsi; struct completion read_ack; struct completion write_ack; - struct completion sync_ack; - bool sync_pending; struct mutex lock; /* protects concurrent access to PMIC Glink interface = */ =20 - int sync_val; - struct work_struct notify_work; struct work_struct register_work; =20 @@ -170,35 +166,6 @@ static int pmic_glink_ucsi_async_control(struct ucsi *= __ucsi, u64 command) return ret; } =20 -static int pmic_glink_ucsi_sync_control(struct ucsi *__ucsi, u64 command) -{ - struct pmic_glink_ucsi *ucsi =3D ucsi_get_drvdata(__ucsi); - unsigned long left; - int ret; - - /* TOFIX: Downstream forces recipient to CON when UCSI_GET_ALTERNATE_MODE= S command */ - - mutex_lock(&ucsi->lock); - ucsi->sync_val =3D 0; - reinit_completion(&ucsi->sync_ack); - ucsi->sync_pending =3D true; - ret =3D pmic_glink_ucsi_locked_write(ucsi, UCSI_CONTROL, &command, sizeof= (command)); - mutex_unlock(&ucsi->lock); - - left =3D wait_for_completion_timeout(&ucsi->sync_ack, 5 * HZ); - if (!left) { - dev_err(ucsi->dev, "timeout waiting for UCSI sync write response\n"); - /* return 0 here and let core UCSI code handle the CCI_BUSY */ - ret =3D 0; - } else if (ucsi->sync_val) { - dev_err(ucsi->dev, "sync write returned: %d\n", ucsi->sync_val); - } - - ucsi->sync_pending =3D false; - - return ret; -} - static void pmic_glink_ucsi_update_connector(struct ucsi_connector *con) { struct pmic_glink_ucsi *ucsi =3D ucsi_get_drvdata(con->ucsi); @@ -232,7 +199,7 @@ static const struct ucsi_operations pmic_glink_ucsi_ops= =3D { .read_version =3D pmic_glink_ucsi_read_version, .read_cci =3D pmic_glink_ucsi_read_cci, .read_message_in =3D pmic_glink_ucsi_read_message_in, - .sync_control =3D pmic_glink_ucsi_sync_control, + .sync_control =3D ucsi_sync_control_common, .async_control =3D pmic_glink_ucsi_async_control, .update_connector =3D pmic_glink_ucsi_update_connector, .connector_status =3D pmic_glink_ucsi_connector_status, @@ -256,14 +223,12 @@ static void pmic_glink_ucsi_write_ack(struct pmic_gli= nk_ucsi *ucsi, const void * if (resp->ret_code) return; =20 - ucsi->sync_val =3D resp->ret_code; complete(&ucsi->write_ack); } =20 static void pmic_glink_ucsi_notify(struct work_struct *work) { struct pmic_glink_ucsi *ucsi =3D container_of(work, struct pmic_glink_ucs= i, notify_work); - unsigned int con_num; u32 cci; int ret; =20 @@ -273,14 +238,7 @@ static void pmic_glink_ucsi_notify(struct work_struct = *work) return; } =20 - con_num =3D UCSI_CCI_CONNECTOR(cci); - if (con_num) - ucsi_connector_change(ucsi->ucsi, con_num); - - if (ucsi->sync_pending && - (cci & (UCSI_CCI_ACK_COMPLETE | UCSI_CCI_COMMAND_COMPLETE))) { - complete(&ucsi->sync_ack); - } + ucsi_notify_common(ucsi->ucsi, cci); } =20 static void pmic_glink_ucsi_register(struct work_struct *work) @@ -362,7 +320,6 @@ static int pmic_glink_ucsi_probe(struct auxiliary_devic= e *adev, INIT_WORK(&ucsi->register_work, pmic_glink_ucsi_register); init_completion(&ucsi->read_ack); init_completion(&ucsi->write_ack); - init_completion(&ucsi->sync_ack); mutex_init(&ucsi->lock); =20 ucsi->ucsi =3D ucsi_create(dev, &pmic_glink_ucsi_ops); diff --git a/drivers/usb/typec/ucsi/ucsi_stm32g0.c b/drivers/usb/typec/ucsi= /ucsi_stm32g0.c index 14737ca3724c..d948c3f579e1 100644 --- a/drivers/usb/typec/ucsi/ucsi_stm32g0.c +++ b/drivers/usb/typec/ucsi/ucsi_stm32g0.c @@ -61,11 +61,7 @@ struct ucsi_stm32g0 { struct i2c_client *i2c_bl; bool in_bootloader; u8 bl_version; - struct completion complete; struct device *dev; - unsigned long flags; -#define COMMAND_PENDING 1 -#define ACK_PENDING 2 const char *fw_name; struct ucsi *ucsi; bool suspended; @@ -407,35 +403,6 @@ static int ucsi_stm32g0_async_control(struct ucsi *ucs= i, u64 command) return 0; } =20 -static int ucsi_stm32g0_sync_control(struct ucsi *ucsi, u64 command) -{ - struct ucsi_stm32g0 *g0 =3D ucsi_get_drvdata(ucsi); - bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; - int ret; - - if (ack) - set_bit(ACK_PENDING, &g0->flags); - else - set_bit(COMMAND_PENDING, &g0->flags); - - ret =3D ucsi_stm32g0_async_control(ucsi, command); - if (ret) - goto out_clear_bit; - - if (!wait_for_completion_timeout(&g0->complete, msecs_to_jiffies(5000))) - ret =3D -ETIMEDOUT; - else - return 0; - -out_clear_bit: - if (ack) - clear_bit(ACK_PENDING, &g0->flags); - else - clear_bit(COMMAND_PENDING, &g0->flags); - - return ret; -} - static irqreturn_t ucsi_stm32g0_irq_handler(int irq, void *data) { struct ucsi_stm32g0 *g0 =3D data; @@ -449,13 +416,7 @@ static irqreturn_t ucsi_stm32g0_irq_handler(int irq, v= oid *data) if (ret) return IRQ_NONE; =20 - if (UCSI_CCI_CONNECTOR(cci)) - ucsi_connector_change(g0->ucsi, UCSI_CCI_CONNECTOR(cci)); - - if (cci & UCSI_CCI_ACK_COMPLETE && test_and_clear_bit(ACK_PENDING, &g0->f= lags)) - complete(&g0->complete); - if (cci & UCSI_CCI_COMMAND_COMPLETE && test_and_clear_bit(COMMAND_PENDING= , &g0->flags)) - complete(&g0->complete); + ucsi_notify_common(g0->ucsi, cci); =20 return IRQ_HANDLED; } @@ -464,7 +425,7 @@ static const struct ucsi_operations ucsi_stm32g0_ops = =3D { .read_version =3D ucsi_stm32g0_read_version, .read_cci =3D ucsi_stm32g0_read_cci, .read_message_in =3D ucsi_stm32g0_read_message_in, - .sync_control =3D ucsi_stm32g0_sync_control, + .sync_control =3D ucsi_sync_control_common, .async_control =3D ucsi_stm32g0_async_control, }; =20 @@ -665,7 +626,6 @@ static int ucsi_stm32g0_probe(struct i2c_client *client) =20 g0->dev =3D dev; g0->client =3D client; - init_completion(&g0->complete); i2c_set_clientdata(client, g0); =20 g0->ucsi =3D ucsi_create(dev, &ucsi_stm32g0_ops); diff --git a/drivers/usb/typec/ucsi/ucsi_yoga_c630.c b/drivers/usb/typec/uc= si/ucsi_yoga_c630.c index 95a333ad5496..f3a5e24ea84d 100644 --- a/drivers/usb/typec/ucsi/ucsi_yoga_c630.c +++ b/drivers/usb/typec/ucsi/ucsi_yoga_c630.c @@ -20,10 +20,6 @@ struct yoga_c630_ucsi { struct yoga_c630_ec *ec; struct ucsi *ucsi; struct notifier_block nb; - struct completion complete; - unsigned long flags; -#define UCSI_C630_COMMAND_PENDING 0 -#define UCSI_C630_ACK_PENDING 1 u16 version; }; =20 @@ -75,57 +71,14 @@ static int yoga_c630_ucsi_async_control(struct ucsi *uc= si, u64 command) return yoga_c630_ec_ucsi_write(uec->ec, (u8*)&command); } =20 -static int yoga_c630_ucsi_sync_control(struct ucsi *ucsi, u64 command) -{ - struct yoga_c630_ucsi *uec =3D ucsi_get_drvdata(ucsi); - bool ack =3D UCSI_COMMAND(command) =3D=3D UCSI_ACK_CC_CI; - int ret; - - if (ack) - set_bit(UCSI_C630_ACK_PENDING, &uec->flags); - else - set_bit(UCSI_C630_COMMAND_PENDING, &uec->flags); - - reinit_completion(&uec->complete); - - ret =3D yoga_c630_ucsi_async_control(ucsi, command); - if (ret) - goto out_clear_bit; - - if (!wait_for_completion_timeout(&uec->complete, 5 * HZ)) - ret =3D -ETIMEDOUT; - -out_clear_bit: - if (ack) - clear_bit(UCSI_C630_ACK_PENDING, &uec->flags); - else - clear_bit(UCSI_C630_COMMAND_PENDING, &uec->flags); - - return ret; -} - const struct ucsi_operations yoga_c630_ucsi_ops =3D { .read_version =3D yoga_c630_ucsi_read_version, .read_cci =3D yoga_c630_ucsi_read_cci, .read_message_in =3D yoga_c630_ucsi_read_message_in, - .sync_control =3D yoga_c630_ucsi_sync_control, + .sync_control =3D ucsi_sync_control_common, .async_control =3D yoga_c630_ucsi_async_control, }; =20 -static void yoga_c630_ucsi_notify_ucsi(struct yoga_c630_ucsi *uec, u32 cci) -{ - if (UCSI_CCI_CONNECTOR(cci)) - ucsi_connector_change(uec->ucsi, UCSI_CCI_CONNECTOR(cci)); - - if (cci & UCSI_CCI_ACK_COMPLETE && - test_bit(UCSI_C630_ACK_PENDING, &uec->flags)) - complete(&uec->complete); - - if (cci & UCSI_CCI_COMMAND_COMPLETE && - test_bit(UCSI_C630_COMMAND_PENDING, &uec->flags)) - complete(&uec->complete); -} - static int yoga_c630_ucsi_notify(struct notifier_block *nb, unsigned long action, void *data) { @@ -144,7 +97,7 @@ static int yoga_c630_ucsi_notify(struct notifier_block *= nb, if (ret) return NOTIFY_DONE; =20 - yoga_c630_ucsi_notify_ucsi(uec, cci); + ucsi_notify_common(uec->ucsi, cci); =20 return NOTIFY_OK; =20 @@ -165,7 +118,6 @@ static int yoga_c630_ucsi_probe(struct auxiliary_device= *adev, return -ENOMEM; =20 uec->ec =3D ec; - init_completion(&uec->complete); uec->nb.notifier_call =3D yoga_c630_ucsi_notify; =20 uec->ucsi =3D ucsi_create(&adev->dev, &yoga_c630_ucsi_ops); --=20 2.39.2 From nobody Wed Dec 17 19:18:04 2025 Received: from mail-lf1-f41.google.com (mail-lf1-f41.google.com [209.85.167.41]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 65330170825 for ; Tue, 25 Jun 2024 14:54:37 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.167.41 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327279; cv=none; b=PoxQeRoch716wxDqZhbklt4HX2s1tdVqFu9t/loCL9iXZJLqw4VvI6zSVmITheyjOHLsaAg4XkNjj3RAvYLKfL4cdIsI9qD3oC4SV3OmX1tW4YZW8XCc1lEMwttvD4bsvRNdrslQkXODFFcMXe39htMbcRBJOZ8w4iywDaH0Tgw= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1719327279; c=relaxed/simple; bh=c1mFXRw/1F7jX+PLOZli37YidJtYzYIZwD0eERkZXpg=; h=From:Date:Subject:MIME-Version:Content-Type:Message-Id:References: In-Reply-To:To:Cc; b=p4c4h81nLCbnjrk8lM9ed9sT4L/90X8itK0Qy9MMHRT+a3aSA3jlMhI3tqgZondYmiYoaM5G8SsbeTiQ85t9tdUggMJ3BatRQaE9NEpv3e+3gzkTbJCDHhPeoH5T+qM1CWw+GFtzqCcTyxAg49I7gnMVrrokPdot7xKzK7LxCLY= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org; spf=pass smtp.mailfrom=linaro.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b=taXzIsgv; arc=none smtp.client-ip=209.85.167.41 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=linaro.org Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=linaro.org Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=linaro.org header.i=@linaro.org header.b="taXzIsgv" Received: by mail-lf1-f41.google.com with SMTP id 2adb3069b0e04-52cf4ca8904so428180e87.3 for ; Tue, 25 Jun 2024 07:54:37 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; t=1719327275; x=1719932075; darn=vger.kernel.org; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:from:to:cc:subject:date:message-id :reply-to; bh=g2gxtQIN+xKJeYZrrZg4eTx3pd8ql0F1T/zN9SBRQsY=; b=taXzIsgvpysuGi9cEp+t84xI8DTRmvYy+7KRZHNOqNUe8RfBM7kMRi0dg+9QaDO1Dh vu35FRL0SVHMz1ncI1n8/HlmNufUbOdA7kdzb2QJd5GMTxM/HIIujG7PJZCkMvw+Z4TC C5maMj9MPgFD49JHA+Nm4edre5AcML2X/waqsrG1kWG+gQONLajC71ZN74ZgVnCdqGyJ z7DN3vKAyf49SDLZTlNYdw1KFtUPpeHNmU+MqqGPkvqJ6WLjc+6tHmr1ihoqWHbHdAQt DdmdvmC+48ANffjhduprSFRcbH8g12rDqXVlIwrzAQsYI40nDTOr4q6oQ3NHaFY7XAR9 oWjA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1719327275; x=1719932075; h=cc:to:in-reply-to:references:message-id:content-transfer-encoding :mime-version:subject:date:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=g2gxtQIN+xKJeYZrrZg4eTx3pd8ql0F1T/zN9SBRQsY=; b=RawlhkaRW7QaopyXIqZCyIUkayM6sz/iOWgYmJK/bMBKTxpR6huxNYwvON7kA0ZDER 9eb5SPyPCUPZwD6wAYRhDTRoITvgbYJV+5BEILytVNsg5QmHkXwLq52xpKDSAol8ACQL 2/jUN5uGXZ7KNV6bUn/P03ijshpL1vqqk+TevUl0sfgTPx2pBjF53n5whq0kb2DZwb8R Rb4uPZkhPCuxrfIgTdCkfoZ2AV+4Qjs9bnmnDT+UF2YQz0MVznLANUqMI9o/f1Hh5esD O2riGt91qvANEllvlOd+KuwcF1JF4oiPao+K1kyyi8MIagk1O6qBI6GR1jglppZ6nL3y sAaw== X-Forwarded-Encrypted: i=1; AJvYcCWLa+cCUt+wUva9a+0GTcaWWcKL8bsGib8pvl4Ha3Wx3J09oZNdhsiaKrl2Y+lrEUPivNJCOeKKtlEv6uaoDlWDNjJEih1yFwK6TnEc X-Gm-Message-State: AOJu0YyJgRHfIlscr4UjaJpPD7FrGZBsskAkiZ/XukCfgvhCLvKXHqp6 B1qVnXzA0VPj4q3kJdrZ0B2hRdW3q8OKHv79ZKy3i1PItzWl3+qNamlCyvi4Y5w= X-Google-Smtp-Source: AGHT+IFgTfwsx7ElY5vsvTSzReP2HLuqQHHg6f+F1C3RO23ndtkGTJu8+wBSZAIAD6eWetNxoUG4Kg== X-Received: by 2002:a05:6512:46f:b0:52c:9f9e:d8e3 with SMTP id 2adb3069b0e04-52ce064e3d8mr4973783e87.31.1719327275739; Tue, 25 Jun 2024 07:54:35 -0700 (PDT) Received: from umbar.lan ([192.130.178.91]) by smtp.gmail.com with ESMTPSA id 2adb3069b0e04-52cd64328b7sm1251877e87.221.2024.06.25.07.54.34 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 25 Jun 2024 07:54:35 -0700 (PDT) From: Dmitry Baryshkov Date: Tue, 25 Jun 2024 17:54:32 +0300 Subject: [PATCH v3 7/7] usb: typec: ucsi: reorder operations in ucsi_run_command() Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Message-Id: <20240625-ucsi-rework-interface-v3-7-7a6c8e17be3a@linaro.org> References: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> In-Reply-To: <20240625-ucsi-rework-interface-v3-0-7a6c8e17be3a@linaro.org> To: Heikki Krogerus , Greg Kroah-Hartman , Maxime Coquelin , Alexandre Torgue Cc: Nikita Travkin , Neil Armstrong , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org, linux-stm32@st-md-mailman.stormreply.com, linux-arm-kernel@lists.infradead.org X-Mailer: b4 0.13.0 X-Developer-Signature: v=1; a=openpgp-sha256; l=2070; i=dmitry.baryshkov@linaro.org; h=from:subject:message-id; bh=c1mFXRw/1F7jX+PLOZli37YidJtYzYIZwD0eERkZXpg=; b=owEBbQGS/pANAwAKAYs8ij4CKSjVAcsmYgBmetokKTBUAvA860F4TZ7LaGT2vn3//h0eO5fRP eXnVpE4f++JATMEAAEKAB0WIQRMcISVXLJjVvC4lX+LPIo+Aiko1QUCZnraJAAKCRCLPIo+Aiko 1Y7VCACNYuSM7sEYoqQvGqND2MRdAoZLFky1iBiqT6oimIP7qis1KVCv3F+gBFz/bdKtij+cztp Z5awCnGfW7Httm4zKIIT7NjJpuUDn4ia7oZOW3FAe99Zdq92p1EKUvXKnXApxNz6eom/iOY7qGH ZuClKE5VA15dUN4sl0zW6TTatSGt7zTfkToJ2jq8u83k9ID/maCxlb5V8FISVxuKEqgOJwLGGoE OvAeeooTh9x2NFAt/eeMWZ2D8kgVxeDZw+j5aVfO6x8v8emzAdbZuHaM+qRTH+T7uUXJOiJNXkB 9HVHfVpFVz76fdbmU925vbf0ul+6bFBUI9SNsbusDr5OPJul X-Developer-Key: i=dmitry.baryshkov@linaro.org; a=openpgp; fpr=8F88381DD5C873E4AE487DA5199BF1243632046A Streamline control stream of ucsi_run_command(). Reorder operations so that there is only one call to ucsi_acknowledge(), making sure that all complete commands are acknowledged. This also makes sure that the command is acknowledged even if reading MESSAGE_IN data returns an error. Signed-off-by: Dmitry Baryshkov Reviewed-by: Heikki Krogerus Tested-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 34 ++++++++++++++-------------------- 1 file changed, 14 insertions(+), 20 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index 3fb5d3a52b80..0d091f06abd3 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -95,7 +95,7 @@ static int ucsi_acknowledge(struct ucsi *ucsi, bool conn_= ack) static int ucsi_run_command(struct ucsi *ucsi, u64 command, u32 *cci, void *data, size_t size, bool conn_ack) { - int ret; + int ret, err; =20 *cci =3D 0; =20 @@ -120,30 +120,24 @@ static int ucsi_run_command(struct ucsi *ucsi, u64 co= mmand, u32 *cci, if (!(*cci & UCSI_CCI_COMMAND_COMPLETE)) return -EIO; =20 - if (*cci & UCSI_CCI_NOT_SUPPORTED) { - if (ucsi_acknowledge(ucsi, false) < 0) - dev_err(ucsi->dev, - "ACK of unsupported command failed\n"); - return -EOPNOTSUPP; - } - - if (*cci & UCSI_CCI_ERROR) { - /* Acknowledge the command that failed */ - ret =3D ucsi_acknowledge(ucsi, false); - return ret ? ret : -EIO; - } + if (*cci & UCSI_CCI_NOT_SUPPORTED) + err =3D -EOPNOTSUPP; + else if (*cci & UCSI_CCI_ERROR) + err =3D -EIO; + else + err =3D 0; =20 - if (data) { - ret =3D ucsi->ops->read_message_in(ucsi, data, size); - if (ret) - return ret; - } + if (!err && data && UCSI_CCI_LENGTH(*cci)) + err =3D ucsi->ops->read_message_in(ucsi, data, size); =20 - ret =3D ucsi_acknowledge(ucsi, conn_ack); + /* + * Don't ACK connection change if there was an error. + */ + ret =3D ucsi_acknowledge(ucsi, err ? false : conn_ack); if (ret) return ret; =20 - return 0; + return err; } =20 static int ucsi_read_error(struct ucsi *ucsi) --=20 2.39.2