Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 1 | /* |
| 2 | * |
| 3 | * Intel Management Engine Interface (Intel MEI) Linux driver |
Tomas Winkler | 733ba91 | 2012-02-09 19:25:53 +0200 | [diff] [blame] | 4 | * Copyright (c) 2003-2012, Intel Corporation. |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify it |
| 7 | * under the terms and conditions of the GNU General Public License, |
| 8 | * version 2, as published by the Free Software Foundation. |
| 9 | * |
| 10 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 11 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 12 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 13 | * more details. |
| 14 | * |
| 15 | */ |
| 16 | |
| 17 | #include <linux/pci.h> |
Tomas Winkler | 4f3afe1 | 2012-05-09 16:38:59 +0300 | [diff] [blame] | 18 | #include <linux/mei.h> |
Tomas Winkler | 47a7380 | 2012-12-25 19:06:03 +0200 | [diff] [blame] | 19 | |
| 20 | #include "mei_dev.h" |
Tomas Winkler | 9dc64d6 | 2013-01-08 23:07:17 +0200 | [diff] [blame] | 21 | #include "hw-me.h" |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 22 | |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 23 | /** |
| 24 | * mei_reg_read - Reads 32bit data from the mei device |
| 25 | * |
| 26 | * @dev: the device structure |
| 27 | * @offset: offset from which to read the data |
| 28 | * |
| 29 | * returns register value (u32) |
| 30 | */ |
| 31 | static inline u32 mei_reg_read(const struct mei_device *dev, |
| 32 | unsigned long offset) |
| 33 | { |
| 34 | return ioread32(dev->mem_addr + offset); |
| 35 | } |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 36 | |
| 37 | |
| 38 | /** |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 39 | * mei_reg_write - Writes 32bit data to the mei device |
| 40 | * |
| 41 | * @dev: the device structure |
| 42 | * @offset: offset from which to write the data |
| 43 | * @value: register value to write (u32) |
| 44 | */ |
| 45 | static inline void mei_reg_write(const struct mei_device *dev, |
| 46 | unsigned long offset, u32 value) |
| 47 | { |
| 48 | iowrite32(value, dev->mem_addr + offset); |
| 49 | } |
| 50 | |
| 51 | /** |
Tomas Winkler | d025284 | 2013-01-08 23:07:24 +0200 | [diff] [blame] | 52 | * mei_mecbrw_read - Reads 32bit data from ME circular buffer |
| 53 | * read window register |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 54 | * |
| 55 | * @dev: the device structure |
| 56 | * |
Tomas Winkler | d025284 | 2013-01-08 23:07:24 +0200 | [diff] [blame] | 57 | * returns ME_CB_RW register value (u32) |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 58 | */ |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 59 | u32 mei_mecbrw_read(const struct mei_device *dev) |
| 60 | { |
| 61 | return mei_reg_read(dev, ME_CB_RW); |
| 62 | } |
| 63 | /** |
| 64 | * mei_mecsr_read - Reads 32bit data from the ME CSR |
| 65 | * |
| 66 | * @dev: the device structure |
| 67 | * |
| 68 | * returns ME_CSR_HA register value (u32) |
| 69 | */ |
| 70 | u32 mei_mecsr_read(const struct mei_device *dev) |
| 71 | { |
| 72 | return mei_reg_read(dev, ME_CSR_HA); |
| 73 | } |
| 74 | |
| 75 | /** |
Tomas Winkler | d025284 | 2013-01-08 23:07:24 +0200 | [diff] [blame] | 76 | * mei_hcsr_read - Reads 32bit data from the host CSR |
| 77 | * |
| 78 | * @dev: the device structure |
| 79 | * |
| 80 | * returns H_CSR register value (u32) |
| 81 | */ |
| 82 | u32 mei_hcsr_read(const struct mei_device *dev) |
| 83 | { |
| 84 | return mei_reg_read(dev, H_CSR); |
| 85 | } |
| 86 | |
| 87 | /** |
| 88 | * mei_hcsr_set - writes H_CSR register to the mei device, |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 89 | * and ignores the H_IS bit for it is write-one-to-zero. |
| 90 | * |
| 91 | * @dev: the device structure |
| 92 | */ |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 93 | static inline void mei_hcsr_set(struct mei_device *dev, u32 hcsr) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 94 | { |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 95 | hcsr &= ~H_IS; |
| 96 | mei_reg_write(dev, H_CSR, hcsr); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 97 | } |
| 98 | |
| 99 | /** |
Tomas Winkler | d025284 | 2013-01-08 23:07:24 +0200 | [diff] [blame] | 100 | * mei_clear_interrupts - clear and stop interrupts |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 101 | * |
| 102 | * @dev: the device structure |
| 103 | */ |
| 104 | void mei_clear_interrupts(struct mei_device *dev) |
| 105 | { |
Tomas Winkler | 9ea73dd | 2013-01-08 23:07:28 +0200 | [diff] [blame] | 106 | u32 hcsr = mei_hcsr_read(dev); |
| 107 | if ((hcsr & H_IS) == H_IS) |
| 108 | mei_reg_write(dev, H_CSR, hcsr); |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 109 | } |
| 110 | |
| 111 | /** |
| 112 | * mei_enable_interrupts - enables mei device interrupts |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 113 | * |
| 114 | * @dev: the device structure |
| 115 | */ |
| 116 | void mei_enable_interrupts(struct mei_device *dev) |
| 117 | { |
Tomas Winkler | 9ea73dd | 2013-01-08 23:07:28 +0200 | [diff] [blame] | 118 | u32 hcsr = mei_hcsr_read(dev); |
| 119 | hcsr |= H_IE; |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 120 | mei_hcsr_set(dev, hcsr); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 121 | } |
| 122 | |
| 123 | /** |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 124 | * mei_disable_interrupts - disables mei device interrupts |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 125 | * |
| 126 | * @dev: the device structure |
| 127 | */ |
| 128 | void mei_disable_interrupts(struct mei_device *dev) |
| 129 | { |
Tomas Winkler | 9ea73dd | 2013-01-08 23:07:28 +0200 | [diff] [blame] | 130 | u32 hcsr = mei_hcsr_read(dev); |
| 131 | hcsr &= ~H_IE; |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 132 | mei_hcsr_set(dev, hcsr); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 133 | } |
| 134 | |
Tomas Winkler | adfba32 | 2013-01-08 23:07:27 +0200 | [diff] [blame] | 135 | /** |
| 136 | * mei_hw_reset - resets fw via mei csr register. |
| 137 | * |
| 138 | * @dev: the device structure |
| 139 | * @interrupts_enabled: if interrupt should be enabled after reset. |
| 140 | */ |
| 141 | void mei_hw_reset(struct mei_device *dev, bool intr_enable) |
| 142 | { |
| 143 | u32 hcsr = mei_hcsr_read(dev); |
| 144 | |
| 145 | dev_dbg(&dev->pdev->dev, "before reset HCSR = 0x%08x.\n", hcsr); |
| 146 | |
| 147 | hcsr |= (H_RST | H_IG); |
| 148 | |
| 149 | if (intr_enable) |
| 150 | hcsr |= H_IE; |
| 151 | else |
| 152 | hcsr &= ~H_IE; |
| 153 | |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 154 | mei_hcsr_set(dev, hcsr); |
Tomas Winkler | adfba32 | 2013-01-08 23:07:27 +0200 | [diff] [blame] | 155 | |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 156 | hcsr = mei_hcsr_read(dev) | H_IG; |
Tomas Winkler | adfba32 | 2013-01-08 23:07:27 +0200 | [diff] [blame] | 157 | hcsr &= ~H_RST; |
Tomas Winkler | adfba32 | 2013-01-08 23:07:27 +0200 | [diff] [blame] | 158 | |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 159 | mei_hcsr_set(dev, hcsr); |
Tomas Winkler | adfba32 | 2013-01-08 23:07:27 +0200 | [diff] [blame] | 160 | |
| 161 | hcsr = mei_hcsr_read(dev); |
| 162 | |
| 163 | dev_dbg(&dev->pdev->dev, "current HCSR = 0x%08x.\n", hcsr); |
| 164 | } |
| 165 | |
Tomas Winkler | 115ba28 | 2013-01-08 23:07:29 +0200 | [diff] [blame] | 166 | /** |
| 167 | * mei_host_set_ready - enable device |
| 168 | * |
| 169 | * @dev - mei device |
| 170 | * returns bool |
| 171 | */ |
| 172 | |
| 173 | void mei_host_set_ready(struct mei_device *dev) |
| 174 | { |
| 175 | dev->host_hw_state |= H_IE | H_IG | H_RDY; |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 176 | mei_hcsr_set(dev, dev->host_hw_state); |
Tomas Winkler | 115ba28 | 2013-01-08 23:07:29 +0200 | [diff] [blame] | 177 | } |
| 178 | /** |
| 179 | * mei_host_is_ready - check whether the host has turned ready |
| 180 | * |
| 181 | * @dev - mei device |
| 182 | * returns bool |
| 183 | */ |
| 184 | bool mei_host_is_ready(struct mei_device *dev) |
| 185 | { |
| 186 | return (dev->host_hw_state & H_RDY) == H_RDY; |
| 187 | } |
| 188 | |
| 189 | /** |
| 190 | * mei_me_is_ready - check whether the me has turned ready |
| 191 | * |
| 192 | * @dev - mei device |
| 193 | * returns bool |
| 194 | */ |
| 195 | bool mei_me_is_ready(struct mei_device *dev) |
| 196 | { |
| 197 | return (dev->me_hw_state & ME_RDY_HRA) == ME_RDY_HRA; |
| 198 | } |
Tomas Winkler | 3a65dd4 | 2012-12-25 19:06:06 +0200 | [diff] [blame] | 199 | |
| 200 | /** |
| 201 | * mei_interrupt_quick_handler - The ISR of the MEI device |
| 202 | * |
| 203 | * @irq: The irq number |
| 204 | * @dev_id: pointer to the device structure |
| 205 | * |
| 206 | * returns irqreturn_t |
| 207 | */ |
| 208 | irqreturn_t mei_interrupt_quick_handler(int irq, void *dev_id) |
| 209 | { |
| 210 | struct mei_device *dev = (struct mei_device *) dev_id; |
| 211 | u32 csr_reg = mei_hcsr_read(dev); |
| 212 | |
| 213 | if ((csr_reg & H_IS) != H_IS) |
| 214 | return IRQ_NONE; |
| 215 | |
| 216 | /* clear H_IS bit in H_CSR */ |
| 217 | mei_reg_write(dev, H_CSR, csr_reg); |
| 218 | |
| 219 | return IRQ_WAKE_THREAD; |
| 220 | } |
| 221 | |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 222 | /** |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 223 | * mei_hbuf_filled_slots - gets number of device filled buffer slots |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 224 | * |
| 225 | * @device: the device structure |
| 226 | * |
| 227 | * returns number of filled slots |
| 228 | */ |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 229 | static unsigned char mei_hbuf_filled_slots(struct mei_device *dev) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 230 | { |
| 231 | char read_ptr, write_ptr; |
| 232 | |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 233 | dev->host_hw_state = mei_hcsr_read(dev); |
| 234 | |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 235 | read_ptr = (char) ((dev->host_hw_state & H_CBRP) >> 8); |
| 236 | write_ptr = (char) ((dev->host_hw_state & H_CBWP) >> 16); |
| 237 | |
| 238 | return (unsigned char) (write_ptr - read_ptr); |
| 239 | } |
| 240 | |
| 241 | /** |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 242 | * mei_hbuf_is_empty - checks if host buffer is empty. |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 243 | * |
| 244 | * @dev: the device structure |
| 245 | * |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 246 | * returns true if empty, false - otherwise. |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 247 | */ |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 248 | bool mei_hbuf_is_empty(struct mei_device *dev) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 249 | { |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 250 | return mei_hbuf_filled_slots(dev) == 0; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 251 | } |
| 252 | |
| 253 | /** |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 254 | * mei_hbuf_empty_slots - counts write empty slots. |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 255 | * |
| 256 | * @dev: the device structure |
| 257 | * |
| 258 | * returns -1(ESLOTS_OVERFLOW) if overflow, otherwise empty slots count |
| 259 | */ |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 260 | int mei_hbuf_empty_slots(struct mei_device *dev) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 261 | { |
Tomas Winkler | 24aadc8 | 2012-06-25 23:46:27 +0300 | [diff] [blame] | 262 | unsigned char filled_slots, empty_slots; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 263 | |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 264 | filled_slots = mei_hbuf_filled_slots(dev); |
Tomas Winkler | 24aadc8 | 2012-06-25 23:46:27 +0300 | [diff] [blame] | 265 | empty_slots = dev->hbuf_depth - filled_slots; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 266 | |
| 267 | /* check for overflow */ |
Tomas Winkler | 24aadc8 | 2012-06-25 23:46:27 +0300 | [diff] [blame] | 268 | if (filled_slots > dev->hbuf_depth) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 269 | return -EOVERFLOW; |
| 270 | |
| 271 | return empty_slots; |
| 272 | } |
| 273 | |
| 274 | /** |
| 275 | * mei_write_message - writes a message to mei device. |
| 276 | * |
| 277 | * @dev: the device structure |
Tomas Winkler | 438763f | 2012-12-25 19:05:59 +0200 | [diff] [blame] | 278 | * @hader: mei HECI header of message |
| 279 | * @buf: message payload will be written |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 280 | * |
Tomas Winkler | 1ccb7b6 | 2012-03-14 14:39:42 +0200 | [diff] [blame] | 281 | * This function returns -EIO if write has failed |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 282 | */ |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 283 | int mei_write_message(struct mei_device *dev, struct mei_msg_hdr *header, |
Tomas Winkler | 438763f | 2012-12-25 19:05:59 +0200 | [diff] [blame] | 284 | unsigned char *buf) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 285 | { |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 286 | unsigned long rem, dw_cnt; |
Tomas Winkler | 438763f | 2012-12-25 19:05:59 +0200 | [diff] [blame] | 287 | unsigned long length = header->length; |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 288 | u32 *reg_buf = (u32 *)buf; |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 289 | u32 hcsr; |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 290 | int i; |
| 291 | int empty_slots; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 292 | |
Tomas Winkler | 15d4acc | 2012-12-25 19:06:00 +0200 | [diff] [blame] | 293 | dev_dbg(&dev->pdev->dev, MEI_HDR_FMT, MEI_HDR_PRM(header)); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 294 | |
Tomas Winkler | 726917f | 2012-06-25 23:46:28 +0300 | [diff] [blame] | 295 | empty_slots = mei_hbuf_empty_slots(dev); |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 296 | dev_dbg(&dev->pdev->dev, "empty slots = %hu.\n", empty_slots); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 297 | |
Tomas Winkler | 7bdf72d | 2012-07-04 19:24:52 +0300 | [diff] [blame] | 298 | dw_cnt = mei_data2slots(length); |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 299 | if (empty_slots < 0 || dw_cnt > empty_slots) |
Tomas Winkler | 1ccb7b6 | 2012-03-14 14:39:42 +0200 | [diff] [blame] | 300 | return -EIO; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 301 | |
| 302 | mei_reg_write(dev, H_CB_WW, *((u32 *) header)); |
| 303 | |
Tomas Winkler | 169d133 | 2012-06-19 09:13:35 +0300 | [diff] [blame] | 304 | for (i = 0; i < length / 4; i++) |
| 305 | mei_reg_write(dev, H_CB_WW, reg_buf[i]); |
| 306 | |
| 307 | rem = length & 0x3; |
| 308 | if (rem > 0) { |
| 309 | u32 reg = 0; |
| 310 | memcpy(®, &buf[length - rem], rem); |
| 311 | mei_reg_write(dev, H_CB_WW, reg); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 312 | } |
| 313 | |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 314 | hcsr = mei_hcsr_read(dev) | H_IG; |
| 315 | mei_hcsr_set(dev, hcsr); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 316 | dev->me_hw_state = mei_mecsr_read(dev); |
Tomas Winkler | 115ba28 | 2013-01-08 23:07:29 +0200 | [diff] [blame] | 317 | if (!mei_me_is_ready(dev)) |
Tomas Winkler | 1ccb7b6 | 2012-03-14 14:39:42 +0200 | [diff] [blame] | 318 | return -EIO; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 319 | |
Tomas Winkler | 1ccb7b6 | 2012-03-14 14:39:42 +0200 | [diff] [blame] | 320 | return 0; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 321 | } |
| 322 | |
| 323 | /** |
| 324 | * mei_count_full_read_slots - counts read full slots. |
| 325 | * |
| 326 | * @dev: the device structure |
| 327 | * |
| 328 | * returns -1(ESLOTS_OVERFLOW) if overflow, otherwise filled slots count |
| 329 | */ |
| 330 | int mei_count_full_read_slots(struct mei_device *dev) |
| 331 | { |
| 332 | char read_ptr, write_ptr; |
| 333 | unsigned char buffer_depth, filled_slots; |
| 334 | |
| 335 | dev->me_hw_state = mei_mecsr_read(dev); |
| 336 | buffer_depth = (unsigned char)((dev->me_hw_state & ME_CBD_HRA) >> 24); |
| 337 | read_ptr = (char) ((dev->me_hw_state & ME_CBRP_HRA) >> 8); |
| 338 | write_ptr = (char) ((dev->me_hw_state & ME_CBWP_HRA) >> 16); |
| 339 | filled_slots = (unsigned char) (write_ptr - read_ptr); |
| 340 | |
| 341 | /* check for overflow */ |
| 342 | if (filled_slots > buffer_depth) |
| 343 | return -EOVERFLOW; |
| 344 | |
| 345 | dev_dbg(&dev->pdev->dev, "filled_slots =%08x\n", filled_slots); |
| 346 | return (int)filled_slots; |
| 347 | } |
| 348 | |
| 349 | /** |
| 350 | * mei_read_slots - reads a message from mei device. |
| 351 | * |
| 352 | * @dev: the device structure |
| 353 | * @buffer: message buffer will be written |
| 354 | * @buffer_length: message size will be read |
| 355 | */ |
Tomas Winkler | edf1eed | 2012-02-09 19:25:54 +0200 | [diff] [blame] | 356 | void mei_read_slots(struct mei_device *dev, unsigned char *buffer, |
| 357 | unsigned long buffer_length) |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 358 | { |
Tomas Winkler | edf1eed | 2012-02-09 19:25:54 +0200 | [diff] [blame] | 359 | u32 *reg_buf = (u32 *)buffer; |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 360 | u32 hcsr; |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 361 | |
Tomas Winkler | edf1eed | 2012-02-09 19:25:54 +0200 | [diff] [blame] | 362 | for (; buffer_length >= sizeof(u32); buffer_length -= sizeof(u32)) |
| 363 | *reg_buf++ = mei_mecbrw_read(dev); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 364 | |
| 365 | if (buffer_length > 0) { |
Tomas Winkler | edf1eed | 2012-02-09 19:25:54 +0200 | [diff] [blame] | 366 | u32 reg = mei_mecbrw_read(dev); |
| 367 | memcpy(reg_buf, ®, buffer_length); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 368 | } |
| 369 | |
Tomas Winkler | 88eb99f | 2013-01-08 23:07:30 +0200 | [diff] [blame^] | 370 | hcsr = mei_hcsr_read(dev) | H_IG; |
| 371 | mei_hcsr_set(dev, hcsr); |
Oren Weil | 3ce7272 | 2011-05-15 13:43:43 +0300 | [diff] [blame] | 372 | } |
| 373 | |