Received: by 2002:a05:6a10:16a7:0:0:0:0 with SMTP id gp39csp523266pxb; Thu, 12 Nov 2020 09:23:59 -0800 (PST) X-Google-Smtp-Source: ABdhPJxiF/MiwJJT5NshydP028MbTXU+uI6UjuxL+sfAi46jVRPW3IbwEVz5+3co6ByL5bJEA/u3 X-Received: by 2002:a17:906:1f53:: with SMTP id d19mr289862ejk.255.1605201839599; Thu, 12 Nov 2020 09:23:59 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1605201839; cv=none; d=google.com; s=arc-20160816; b=qpEBg0klwxGBUIfkDaYScRUVNpqNMaIJ6JDXLXtp0gSjqTIHI635s26suvFm4ryuRb F1XZ4xYJmpUvIfiUsufMSuzegvuxZdk1mUDI9aGPt7S46/0fB/sstoCizt6hzUSbGtKD xNV2Al+SeqzBR8Q/u9rdKdBAeTcGb0DDT9QugyJT1jOyCCrMxToLVx2KSjxSRLx1k7dn tPfu8UnOwBHblOg5UGgbrC2svJY+UwEIaNh/SUMRRtWzMMr3E197h7glLhQA+CV5m3fb J08qxVV+9gVW58X5FNvNaZg8W0ZkFhGN95UKLDaFoWhFMZaPwmXrmTFOZjiUEn6EaJim 9WFg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:content-language :in-reply-to:mime-version:user-agent:date:message-id:autocrypt:from :references:cc:to:subject:sender:dkim-signature; bh=ICBAlo+giQGOzgRDfThfUlitlmZTK0kLnFxLadaHvhQ=; b=0h0tzV+sgNFjVqe2aNGHEDR1oQkqH0NWpRefSWGSa1C1Q8o105dF0JEjChVFe/SaPw EHZKngclkkd7TlzI0OhjLYREpuCu3CtF2HeJIt2Lkt6f91OrZmsqAuuYKNEUhRxp/XxV bSPAAa5IIAVCCtfUdY/RGNOzZKlCTIiOUBVOYKke7Ws84ivZN7HQ/Q4eUC60VFFb/7mn XLej4a9/NiSzjZB1DIVPkb1KL7/EfZa4yngNHBNL7bbZgP1S817i4gKLxBOIxHF+VZt5 ZxIFeDQwv19U5yKp9DFWhaUcBE70spKfUXdK9ZxoYGqina+/qm4k2DBcNMV7ObFG3L7n HjZw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@gmail.com header.s=20161025 header.b=LYy20o+I; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id 18si4023787ejv.717.2020.11.12.09.23.34; Thu, 12 Nov 2020 09:23:59 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; dkim=pass header.i=@gmail.com header.s=20161025 header.b=LYy20o+I; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726216AbgKLRUv (ORCPT + 99 others); Thu, 12 Nov 2020 12:20:51 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:57370 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1725987AbgKLRUu (ORCPT ); Thu, 12 Nov 2020 12:20:50 -0500 Received: from mail-ot1-x341.google.com (mail-ot1-x341.google.com [IPv6:2607:f8b0:4864:20::341]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 8EEB9C0613D1; Thu, 12 Nov 2020 09:20:50 -0800 (PST) Received: by mail-ot1-x341.google.com with SMTP id f16so6294578otl.11; Thu, 12 Nov 2020 09:20:50 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=sender:subject:to:cc:references:from:autocrypt:message-id:date :user-agent:mime-version:in-reply-to:content-language :content-transfer-encoding; bh=ICBAlo+giQGOzgRDfThfUlitlmZTK0kLnFxLadaHvhQ=; b=LYy20o+Iw1VGvep+jmwZOPooty+0LmYZ+YJ/ksRvwqR4wYWOAtCd/OKwNuSwZ69Xsi HpiYaxiSa7nAKSZ9gDZQq2TJryKwnGw/xOrQIWcL+jD4VuZ029erI0mAsfPCy0skKFD/ adg7yXzvPVsJqFLjEJdQyYrSZYLG6ypLl8GYfcsmfVmDJP4uuZdE8rJrD2j0dfrsrEmv zlxebw8pGlJsZyVx89tkGUuQ9Jbfy4APyOQkaMmCnD5TEeDOKtZ4HKRP+FqQXOCDdsNG 1pejmEOS3E7hFqpSRd9ALM0fqmEUUGyqjqDlaWDJS0C8kzS/GR0e3KFYg8MchVVWE1dI l9jA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:sender:subject:to:cc:references:from:autocrypt :message-id:date:user-agent:mime-version:in-reply-to :content-language:content-transfer-encoding; bh=ICBAlo+giQGOzgRDfThfUlitlmZTK0kLnFxLadaHvhQ=; b=ggBg0E+ron6hJ7Eq30pxeC33s1mmtSR1UfKKKkPKuEA/lT85IROmkBqGNKwMiQvqTs rfDt8wogqwv6m/Leyex3yrm7cuTC8qiRo71MyQuaddQM/bOzuTwgbeJK7DgH0isXZGjJ GXGBibD/YwAxh093VX99MjpQ3rjpcQAm/eaPWbO+NE+MUHYuuo0tzvV9+68aieqhMrJC +d2WEpWsflFOb2Hv/NzfeSQd8jFRivqAbrSDzpoUgvWi6OLB3DlVn6kDjgZwN+DpbMN2 7r4J8md0jUsbKoUsvVawUuyxDHC+QXJp4vcUy0pvWLEJtYTdaQhuNXPtNyMpcPi9CLLo AfGA== X-Gm-Message-State: AOAM531Esn7Qr9ALdfrKiAKiKoRDOG9ka2VrOZNUtgKQeEnHdHKAPpQx 4JDPJaO9peyxKoGqHmHTv7Y= X-Received: by 2002:a9d:2255:: with SMTP id o79mr165784ota.174.1605201649819; Thu, 12 Nov 2020 09:20:49 -0800 (PST) Received: from server.roeck-us.net ([2600:1700:e321:62f0:329c:23ff:fee3:9d7c]) by smtp.gmail.com with ESMTPSA id 186sm1374124ooe.20.2020.11.12.09.20.48 (version=TLS1_3 cipher=TLS_AES_128_GCM_SHA256 bits=128/128); Thu, 12 Nov 2020 09:20:49 -0800 (PST) Sender: Guenter Roeck Subject: Re: [PATCH v6 1/1] applesmc: Re-work SMC comms To: Brad Campbell , linux-hwmon@vger.kernel.org Cc: Arnd Bergmann , "linux-kernel@vger.kernel.org" , hns@goldelico.com, Andreas Kemnade , Jean Delvare , Henrik Rydberg References: <20200930105442.3f642f6c@aktux> <20201104142057.62493c12@aktux> <2436afef-99c6-c352-936d-567bf553388c@fnarfbargle.com> <7a085650-2399-08c0-3c4d-6cd1fa28a365@roeck-us.net> <10027199-5d31-93e7-9bd8-7baaebff8b71@roeck-us.net> <70331f82-35a1-50bd-685d-0b06061dd213@fnarfbargle.com> <3c72ccc3-4de1-b5d0-423d-7b8c80991254@fnarfbargle.com> <6d071547-10ee-ca92-ec8b-4b5069d04501@bitmath.org> <8e117844-d62a-bcb1-398d-c59cc0d4b878@fnarfbargle.com> <9109d059-d9cb-7464-edba-3f42aa78ce92@bitmath.org> <5310c0ab-0f80-1f9e-8807-066223edae13@bitmath.org> <57057d07-d3a0-8713-8365-7b12ca222bae@fnarfbargle.com> <4eca09dc-7b32-767c-eab0-b9ad8b41efcc@fnarfbargle.com> <8c525b3b-b4a6-8ee4-8128-a20e0ad408e4@fnarfbargle.com> <194a7d71-a781-765a-d177-c962ef296b90@fnarfbargle.com> From: Guenter Roeck Autocrypt: addr=linux@roeck-us.net; keydata= xsFNBE6H1WcBEACu6jIcw5kZ5dGeJ7E7B2uweQR/4FGxH10/H1O1+ApmcQ9i87XdZQiB9cpN RYHA7RCEK2dh6dDccykQk3bC90xXMPg+O3R+C/SkwcnUak1UZaeK/SwQbq/t0tkMzYDRxfJ7 nyFiKxUehbNF3r9qlJgPqONwX5vJy4/GvDHdddSCxV41P/ejsZ8PykxyJs98UWhF54tGRWFl 7i1xvaDB9lN5WTLRKSO7wICuLiSz5WZHXMkyF4d+/O5ll7yz/o/JxK5vO/sduYDIlFTvBZDh gzaEtNf5tQjsjG4io8E0Yq0ViobLkS2RTNZT8ICq/Jmvl0SpbHRvYwa2DhNsK0YjHFQBB0FX IdhdUEzNefcNcYvqigJpdICoP2e4yJSyflHFO4dr0OrdnGLe1Zi/8Xo/2+M1dSSEt196rXaC kwu2KgIgmkRBb3cp2vIBBIIowU8W3qC1+w+RdMUrZxKGWJ3juwcgveJlzMpMZNyM1jobSXZ0 VHGMNJ3MwXlrEFPXaYJgibcg6brM6wGfX/LBvc/haWw4yO24lT5eitm4UBdIy9pKkKmHHh7s jfZJkB5fWKVdoCv/omy6UyH6ykLOPFugl+hVL2Prf8xrXuZe1CMS7ID9Lc8FaL1ROIN/W8Vk BIsJMaWOhks//7d92Uf3EArDlDShwR2+D+AMon8NULuLBHiEUQARAQABzTJHdWVudGVyIFJv ZWNrIChMaW51eCBhY2NvdW50KSA8bGludXhAcm9lY2stdXMubmV0PsLBgQQTAQIAKwIbAwYL CQgHAwIGFQgCCQoLBBYCAwECHgECF4ACGQEFAlVcphcFCRmg06EACgkQyx8mb86fmYFg0RAA nzXJzuPkLJaOmSIzPAqqnutACchT/meCOgMEpS5oLf6xn5ySZkl23OxuhpMZTVX+49c9pvBx hpvl5bCWFu5qC1jC2eWRYU+aZZE4sxMaAGeWenQJsiG9lP8wkfCJP3ockNu0ZXXAXwIbY1O1 c+l11zQkZw89zNgWgKobKzrDMBFOYtAh0pAInZ9TSn7oA4Ctejouo5wUugmk8MrDtUVXmEA9 7f9fgKYSwl/H7dfKKsS1bDOpyJlqhEAH94BHJdK/b1tzwJCFAXFhMlmlbYEk8kWjcxQgDWMu GAthQzSuAyhqyZwFcOlMCNbAcTSQawSo3B9yM9mHJne5RrAbVz4TWLnEaX8gA5xK3uCNCeyI sqYuzA4OzcMwnnTASvzsGZoYHTFP3DQwf2nzxD6yBGCfwNGIYfS0i8YN8XcBgEcDFMWpOQhT Pu3HeztMnF3HXrc0t7e5rDW9zCh3k2PA6D2NV4fews9KDFhLlTfCVzf0PS1dRVVWM+4jVl6l HRIAgWp+2/f8dx5vPc4Ycp4IsZN0l1h9uT7qm1KTwz+sSl1zOqKD/BpfGNZfLRRxrXthvvY8 BltcuZ4+PGFTcRkMytUbMDFMF9Cjd2W9dXD35PEtvj8wnEyzIos8bbgtLrGTv/SYhmPpahJA l8hPhYvmAvpOmusUUyB30StsHIU2LLccUPPOwU0ETofVZwEQALlLbQeBDTDbwQYrj0gbx3bq 7kpKABxN2MqeuqGr02DpS9883d/t7ontxasXoEz2GTioevvRmllJlPQERVxM8gQoNg22twF7 pB/zsrIjxkE9heE4wYfN1AyzT+AxgYN6f8hVQ7Nrc9XgZZe+8IkuW/Nf64KzNJXnSH4u6nJM J2+Dt274YoFcXR1nG76Q259mKwzbCukKbd6piL+VsT/qBrLhZe9Ivbjq5WMdkQKnP7gYKCAi pNVJC4enWfivZsYupMd9qn7Uv/oCZDYoBTdMSBUblaLMwlcjnPpOYK5rfHvC4opxl+P/Vzyz 6WC2TLkPtKvYvXmdsI6rnEI4Uucg0Au/Ulg7aqqKhzGPIbVaL+U0Wk82nz6hz+WP2ggTrY1w ZlPlRt8WM9w6WfLf2j+PuGklj37m+KvaOEfLsF1v464dSpy1tQVHhhp8LFTxh/6RWkRIR2uF I4v3Xu/k5D0LhaZHpQ4C+xKsQxpTGuYh2tnRaRL14YMW1dlI3HfeB2gj7Yc8XdHh9vkpPyuT nY/ZsFbnvBtiw7GchKKri2gDhRb2QNNDyBnQn5mRFw7CyuFclAksOdV/sdpQnYlYcRQWOUGY HhQ5eqTRZjm9z+qQe/T0HQpmiPTqQcIaG/edgKVTUjITfA7AJMKLQHgp04Vylb+G6jocnQQX JqvvP09whbqrABEBAAHCwWUEGAECAA8CGwwFAlVcpi8FCRmg08MACgkQyx8mb86fmYHNRQ/+ J0OZsBYP4leJvQF8lx9zif+v4ZY/6C9tTcUv/KNAE5leyrD4IKbnV4PnbrVhjq861it/zRQW cFpWQszZyWRwNPWUUz7ejmm9lAwPbr8xWT4qMSA43VKQ7ZCeTQJ4TC8kjqtcbw41SjkjrcTG wF52zFO4bOWyovVAPncvV9eGA/vtnd3xEZXQiSt91kBSqK28yjxAqK/c3G6i7IX2rg6pzgqh hiH3/1qM2M/LSuqAv0Rwrt/k+pZXE+B4Ud42hwmMr0TfhNxG+X7YKvjKC+SjPjqp0CaztQ0H nsDLSLElVROxCd9m8CAUuHplgmR3seYCOrT4jriMFBtKNPtj2EE4DNV4s7k0Zy+6iRQ8G8ng QjsSqYJx8iAR8JRB7Gm2rQOMv8lSRdjva++GT0VLXtHULdlzg8VjDnFZ3lfz5PWEOeIMk7Rj trjv82EZtrhLuLjHRCaG50OOm0hwPSk1J64R8O3HjSLdertmw7eyAYOo4RuWJguYMg5DRnBk WkRwrSuCn7UG+qVWZeKEsFKFOkynOs3pVbcbq1pxbhk3TRWCGRU5JolI4ohy/7JV1TVbjiDI HP/aVnm6NC8of26P40Pg8EdAhajZnHHjA7FrJXsy3cyIGqvg9os4rNkUWmrCfLLsZDHD8FnU mDW4+i+XlNFUPUYMrIKi9joBhu18ssf5i5Q= Message-ID: <711f71f8-4709-4555-32f6-bab993a8d3f2@roeck-us.net> Date: Thu, 12 Nov 2020 09:20:47 -0800 User-Agent: Mozilla/5.0 (X11; Linux x86_64; rv:68.0) Gecko/20100101 Thunderbird/68.10.0 MIME-Version: 1.0 In-Reply-To: <194a7d71-a781-765a-d177-c962ef296b90@fnarfbargle.com> Content-Type: text/plain; charset=utf-8 Content-Language: en-US Content-Transfer-Encoding: 7bit Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On 11/11/20 7:08 PM, Brad Campbell wrote: > Commit fff2d0f701e6 ("hwmon: (applesmc) avoid overlong udelay()") > introduced an issue whereby communication with the SMC became > unreliable with write errors like : > > [ 120.378614] applesmc: send_byte(0x00, 0x0300) fail: 0x40 > [ 120.378621] applesmc: LKSB: write data fail > [ 120.512782] applesmc: send_byte(0x00, 0x0300) fail: 0x40 > [ 120.512787] applesmc: LKSB: write data fail > > The original code appeared to be timing sensitive and was not reliable > with the timing changes in the aforementioned commit. > > This patch re-factors the SMC communication to remove the timing > dependencies and restore function with the changes previously > committed. > > Tested on : MacbookAir6,2 MacBookPro11,1 iMac12,2, MacBookAir1,1, > MacBookAir3,1 > > Fixes: fff2d0f701e6 ("hwmon: (applesmc) avoid overlong udelay()") > Reported-by: Andreas Kemnade > Tested-by: Andreas Kemnade # MacBookAir6,2 > Acked-by: Arnd Bergmann > Signed-off-by: Brad Campbell > Signed-off-by: Henrik Rydberg Applied. Guenter > > --- > Changelog : > v1 : Initial attempt > v2 : Address logic and coding style based on comments received > v3 : Removed some debug hangover. Added tested-by. Modifications for MacBookAir1,1 > - Significant rework of wait logic by Henrik Rydberg to > make it function at all on the MacBookAir1,1. > > v4 : Re-factored logic based on Apple driver. Simplified wait_status loop > - Re-factored the logic again, this time based on the Apple driver. This > functioned without error on all tested Macs. wait_status() contributed > by Henrik Rydberg > > v5 : Re-wrote status loop. Simplified busy check in send_byte() > - Re-wrote wait_status() based on feedback from Guenter Roeck > - Added additional comments to explain multiple tests in send_byte() > - Addressed repeated indentation issues > > v6 : Reverted simplification of busy check in send_byte() > - The logic simplification in v5 send_byte() caused a few read failures in > stress testing on a fast SMC (3 in 5.6million). Reverting that change passed > 5 million reads with 0 errors. > > Index: linux-stable/drivers/hwmon/applesmc.c > =================================================================== > --- linux-stable.orig/drivers/hwmon/applesmc.c > +++ linux-stable/drivers/hwmon/applesmc.c > @@ -32,6 +32,7 @@ > #include > #include > #include > +#include > > /* data port used by Apple SMC */ > #define APPLESMC_DATA_PORT 0x300 > @@ -42,10 +43,13 @@ > > #define APPLESMC_MAX_DATA_LENGTH 32 > > -/* wait up to 128 ms for a status change. */ > -#define APPLESMC_MIN_WAIT 0x0010 > -#define APPLESMC_RETRY_WAIT 0x0100 > -#define APPLESMC_MAX_WAIT 0x20000 > +/* Apple SMC status bits */ > +#define SMC_STATUS_AWAITING_DATA BIT(0) /* SMC has data waiting to be read */ > +#define SMC_STATUS_IB_CLOSED BIT(1) /* Will ignore any input */ > +#define SMC_STATUS_BUSY BIT(2) /* Command in progress */ > + > +/* Initial wait is 8us */ > +#define APPLESMC_MIN_WAIT 0x0008 > > #define APPLESMC_READ_CMD 0x10 > #define APPLESMC_WRITE_CMD 0x11 > @@ -151,65 +155,84 @@ static unsigned int key_at_index; > static struct workqueue_struct *applesmc_led_wq; > > /* > - * wait_read - Wait for a byte to appear on SMC port. Callers must > - * hold applesmc_lock. > + * Wait for specific status bits with a mask on the SMC. > + * Used before all transactions. > + * This does 10 fast loops of 8us then exponentially backs off for a > + * minimum total wait of 262ms. Depending on usleep_range this could > + * run out past 500ms. > */ > -static int wait_read(void) > + > +static int wait_status(u8 val, u8 mask) > { > - unsigned long end = jiffies + (APPLESMC_MAX_WAIT * HZ) / USEC_PER_SEC; > u8 status; > int us; > + int i; > > - for (us = APPLESMC_MIN_WAIT; us < APPLESMC_MAX_WAIT; us <<= 1) { > - usleep_range(us, us * 16); > + us = APPLESMC_MIN_WAIT; > + for (i = 0; i < 24 ; i++) { > status = inb(APPLESMC_CMD_PORT); > - /* read: wait for smc to settle */ > - if (status & 0x01) > + if ((status & mask) == val) > return 0; > - /* timeout: give up */ > - if (time_after(jiffies, end)) > - break; > + usleep_range(us, us * 2); > + if (i > 9) > + us <<= 1; > } > - > - pr_warn("wait_read() fail: 0x%02x\n", status); > return -EIO; > } > > -/* > - * send_byte - Write to SMC port, retrying when necessary. Callers > - * must hold applesmc_lock. > - */ > +/* send_byte - Write to SMC data port. Callers must hold applesmc_lock. */ > + > static int send_byte(u8 cmd, u16 port) > { > - u8 status; > - int us; > - unsigned long end = jiffies + (APPLESMC_MAX_WAIT * HZ) / USEC_PER_SEC; > + int status; > > - outb(cmd, port); > - for (us = APPLESMC_MIN_WAIT; us < APPLESMC_MAX_WAIT; us <<= 1) { > - usleep_range(us, us * 16); > - status = inb(APPLESMC_CMD_PORT); > - /* write: wait for smc to settle */ > - if (status & 0x02) > - continue; > - /* ready: cmd accepted, return */ > - if (status & 0x04) > - return 0; > - /* timeout: give up */ > - if (time_after(jiffies, end)) > - break; > - /* busy: long wait and resend */ > - udelay(APPLESMC_RETRY_WAIT); > - outb(cmd, port); > - } > + status = wait_status(0, SMC_STATUS_IB_CLOSED); > + if (status) > + return status; > + /* > + * This needs to be a separate read looking for bit 0x04 > + * after bit 0x02 falls. If consolidated with the wait above > + * this extra read may not happen if status returns both > + * simultaneously and this would appear to be required. > + */ > + status = wait_status(SMC_STATUS_BUSY, SMC_STATUS_BUSY); > + if (status) > + return status; > > - pr_warn("send_byte(0x%02x, 0x%04x) fail: 0x%02x\n", cmd, port, status); > - return -EIO; > + outb(cmd, port); > + return 0; > } > > +/* send_command - Write a command to the SMC. Callers must hold applesmc_lock. */ > + > static int send_command(u8 cmd) > { > - return send_byte(cmd, APPLESMC_CMD_PORT); > + int ret; > + > + ret = wait_status(0, SMC_STATUS_IB_CLOSED); > + if (ret) > + return ret; > + outb(cmd, APPLESMC_CMD_PORT); > + return 0; > +} > + > +/* > + * Based on logic from the Apple driver. This is issued before any interaction > + * If busy is stuck high, issue a read command to reset the SMC state machine. > + * If busy is stuck high after the command then the SMC is jammed. > + */ > + > +static int smc_sane(void) > +{ > + int ret; > + > + ret = wait_status(0, SMC_STATUS_BUSY); > + if (!ret) > + return ret; > + ret = send_command(APPLESMC_READ_CMD); > + if (ret) > + return ret; > + return wait_status(0, SMC_STATUS_BUSY); > } > > static int send_argument(const char *key) > @@ -226,6 +249,11 @@ static int read_smc(u8 cmd, const char * > { > u8 status, data = 0; > int i; > + int ret; > + > + ret = smc_sane(); > + if (ret) > + return ret; > > if (send_command(cmd) || send_argument(key)) { > pr_warn("%.4s: read arg fail\n", key); > @@ -239,7 +267,8 @@ static int read_smc(u8 cmd, const char * > } > > for (i = 0; i < len; i++) { > - if (wait_read()) { > + if (wait_status(SMC_STATUS_AWAITING_DATA | SMC_STATUS_BUSY, > + SMC_STATUS_AWAITING_DATA | SMC_STATUS_BUSY)) { > pr_warn("%.4s: read data[%d] fail\n", key, i); > return -EIO; > } > @@ -250,19 +279,24 @@ static int read_smc(u8 cmd, const char * > for (i = 0; i < 16; i++) { > udelay(APPLESMC_MIN_WAIT); > status = inb(APPLESMC_CMD_PORT); > - if (!(status & 0x01)) > + if (!(status & SMC_STATUS_AWAITING_DATA)) > break; > data = inb(APPLESMC_DATA_PORT); > } > if (i) > pr_warn("flushed %d bytes, last value is: %d\n", i, data); > > - return 0; > + return wait_status(0, SMC_STATUS_BUSY); > } > > static int write_smc(u8 cmd, const char *key, const u8 *buffer, u8 len) > { > int i; > + int ret; > + > + ret = smc_sane(); > + if (ret) > + return ret; > > if (send_command(cmd) || send_argument(key)) { > pr_warn("%s: write arg fail\n", key); > @@ -281,7 +315,7 @@ static int write_smc(u8 cmd, const char > } > } > > - return 0; > + return wait_status(0, SMC_STATUS_BUSY); > } > > static int read_register_count(unsigned int *count) >