diff options
| -rw-r--r-- | drivers/mfd/cros_ec_spi.c | 52 |
1 files changed, 24 insertions, 28 deletions
diff --git a/drivers/mfd/cros_ec_spi.c b/drivers/mfd/cros_ec_spi.c index a14196e95e9b..59c82cdcf48d 100644 --- a/drivers/mfd/cros_ec_spi.c +++ b/drivers/mfd/cros_ec_spi.c | |||
| @@ -377,6 +377,7 @@ static int cros_ec_pkt_xfer_spi(struct cros_ec_device *ec_dev, | |||
| 377 | u8 *ptr; | 377 | u8 *ptr; |
| 378 | u8 *rx_buf; | 378 | u8 *rx_buf; |
| 379 | u8 sum; | 379 | u8 sum; |
| 380 | u8 rx_byte; | ||
| 380 | int ret = 0, final_ret; | 381 | int ret = 0, final_ret; |
| 381 | 382 | ||
| 382 | len = cros_ec_prepare_tx(ec_dev, ec_msg); | 383 | len = cros_ec_prepare_tx(ec_dev, ec_msg); |
| @@ -421,25 +422,22 @@ static int cros_ec_pkt_xfer_spi(struct cros_ec_device *ec_dev, | |||
| 421 | if (!ret) { | 422 | if (!ret) { |
| 422 | /* Verify that EC can process command */ | 423 | /* Verify that EC can process command */ |
| 423 | for (i = 0; i < len; i++) { | 424 | for (i = 0; i < len; i++) { |
| 424 | switch (rx_buf[i]) { | 425 | rx_byte = rx_buf[i]; |
| 425 | case EC_SPI_PAST_END: | 426 | if (rx_byte == EC_SPI_PAST_END || |
| 426 | case EC_SPI_RX_BAD_DATA: | 427 | rx_byte == EC_SPI_RX_BAD_DATA || |
| 427 | case EC_SPI_NOT_READY: | 428 | rx_byte == EC_SPI_NOT_READY) { |
| 428 | ret = -EAGAIN; | 429 | ret = -EREMOTEIO; |
| 429 | ec_msg->result = EC_RES_IN_PROGRESS; | ||
| 430 | default: | ||
| 431 | break; | 430 | break; |
| 432 | } | 431 | } |
| 433 | if (ret) | ||
| 434 | break; | ||
| 435 | } | 432 | } |
| 436 | if (!ret) | ||
| 437 | ret = cros_ec_spi_receive_packet(ec_dev, | ||
| 438 | ec_msg->insize + sizeof(*response)); | ||
| 439 | } else { | ||
| 440 | dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret); | ||
| 441 | } | 433 | } |
| 442 | 434 | ||
| 435 | if (!ret) | ||
| 436 | ret = cros_ec_spi_receive_packet(ec_dev, | ||
| 437 | ec_msg->insize + sizeof(*response)); | ||
| 438 | else | ||
| 439 | dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret); | ||
| 440 | |||
| 443 | final_ret = terminate_request(ec_dev); | 441 | final_ret = terminate_request(ec_dev); |
| 444 | 442 | ||
| 445 | spi_bus_unlock(ec_spi->spi->master); | 443 | spi_bus_unlock(ec_spi->spi->master); |
| @@ -508,6 +506,7 @@ static int cros_ec_cmd_xfer_spi(struct cros_ec_device *ec_dev, | |||
| 508 | int i, len; | 506 | int i, len; |
| 509 | u8 *ptr; | 507 | u8 *ptr; |
| 510 | u8 *rx_buf; | 508 | u8 *rx_buf; |
| 509 | u8 rx_byte; | ||
| 511 | int sum; | 510 | int sum; |
| 512 | int ret = 0, final_ret; | 511 | int ret = 0, final_ret; |
| 513 | 512 | ||
| @@ -544,25 +543,22 @@ static int cros_ec_cmd_xfer_spi(struct cros_ec_device *ec_dev, | |||
| 544 | if (!ret) { | 543 | if (!ret) { |
| 545 | /* Verify that EC can process command */ | 544 | /* Verify that EC can process command */ |
| 546 | for (i = 0; i < len; i++) { | 545 | for (i = 0; i < len; i++) { |
| 547 | switch (rx_buf[i]) { | 546 | rx_byte = rx_buf[i]; |
| 548 | case EC_SPI_PAST_END: | 547 | if (rx_byte == EC_SPI_PAST_END || |
| 549 | case EC_SPI_RX_BAD_DATA: | 548 | rx_byte == EC_SPI_RX_BAD_DATA || |
| 550 | case EC_SPI_NOT_READY: | 549 | rx_byte == EC_SPI_NOT_READY) { |
| 551 | ret = -EAGAIN; | 550 | ret = -EREMOTEIO; |
| 552 | ec_msg->result = EC_RES_IN_PROGRESS; | ||
| 553 | default: | ||
| 554 | break; | 551 | break; |
| 555 | } | 552 | } |
| 556 | if (ret) | ||
| 557 | break; | ||
| 558 | } | 553 | } |
| 559 | if (!ret) | ||
| 560 | ret = cros_ec_spi_receive_response(ec_dev, | ||
| 561 | ec_msg->insize + EC_MSG_TX_PROTO_BYTES); | ||
| 562 | } else { | ||
| 563 | dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret); | ||
| 564 | } | 554 | } |
| 565 | 555 | ||
| 556 | if (!ret) | ||
| 557 | ret = cros_ec_spi_receive_response(ec_dev, | ||
| 558 | ec_msg->insize + EC_MSG_TX_PROTO_BYTES); | ||
| 559 | else | ||
| 560 | dev_err(ec_dev->dev, "spi transfer failed: %d\n", ret); | ||
| 561 | |||
| 566 | final_ret = terminate_request(ec_dev); | 562 | final_ret = terminate_request(ec_dev); |
| 567 | 563 | ||
| 568 | spi_bus_unlock(ec_spi->spi->master); | 564 | spi_bus_unlock(ec_spi->spi->master); |
