1b285192aSMauro Carvalho Chehab /* 2b285192aSMauro Carvalho Chehab * Driver for the NXP SAA7164 PCIe bridge 3b285192aSMauro Carvalho Chehab * 4b285192aSMauro Carvalho Chehab * Copyright (c) 2010 Steven Toth <stoth@kernellabs.com> 5b285192aSMauro Carvalho Chehab * 6b285192aSMauro Carvalho Chehab * This program is free software; you can redistribute it and/or modify 7b285192aSMauro Carvalho Chehab * it under the terms of the GNU General Public License as published by 8b285192aSMauro Carvalho Chehab * the Free Software Foundation; either version 2 of the License, or 9b285192aSMauro Carvalho Chehab * (at your option) any later version. 10b285192aSMauro Carvalho Chehab * 11b285192aSMauro Carvalho Chehab * This program is distributed in the hope that it will be useful, 12b285192aSMauro Carvalho Chehab * but WITHOUT ANY WARRANTY; without even the implied warranty of 13b285192aSMauro Carvalho Chehab * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14b285192aSMauro Carvalho Chehab * 15b285192aSMauro Carvalho Chehab * GNU General Public License for more details. 16b285192aSMauro Carvalho Chehab * 17b285192aSMauro Carvalho Chehab * You should have received a copy of the GNU General Public License 18b285192aSMauro Carvalho Chehab * along with this program; if not, write to the Free Software 19b285192aSMauro Carvalho Chehab * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 20b285192aSMauro Carvalho Chehab */ 21b285192aSMauro Carvalho Chehab 22b285192aSMauro Carvalho Chehab #include "saa7164.h" 23b285192aSMauro Carvalho Chehab 24b285192aSMauro Carvalho Chehab /* The message bus to/from the firmware is a ring buffer in PCI address 25b285192aSMauro Carvalho Chehab * space. Establish the defaults. 26b285192aSMauro Carvalho Chehab */ 27b285192aSMauro Carvalho Chehab int saa7164_bus_setup(struct saa7164_dev *dev) 28b285192aSMauro Carvalho Chehab { 29b285192aSMauro Carvalho Chehab struct tmComResBusInfo *b = &dev->bus; 30b285192aSMauro Carvalho Chehab 31b285192aSMauro Carvalho Chehab mutex_init(&b->lock); 32b285192aSMauro Carvalho Chehab 33b285192aSMauro Carvalho Chehab b->Type = TYPE_BUS_PCIe; 34b285192aSMauro Carvalho Chehab b->m_wMaxReqSize = SAA_DEVICE_MAXREQUESTSIZE; 35b285192aSMauro Carvalho Chehab 36b285192aSMauro Carvalho Chehab b->m_pdwSetRing = (u8 *)(dev->bmmio + 37b285192aSMauro Carvalho Chehab ((u32)dev->busdesc.CommandRing)); 38b285192aSMauro Carvalho Chehab 39b285192aSMauro Carvalho Chehab b->m_dwSizeSetRing = SAA_DEVICE_BUFFERBLOCKSIZE; 40b285192aSMauro Carvalho Chehab 41b285192aSMauro Carvalho Chehab b->m_pdwGetRing = (u8 *)(dev->bmmio + 42b285192aSMauro Carvalho Chehab ((u32)dev->busdesc.ResponseRing)); 43b285192aSMauro Carvalho Chehab 44b285192aSMauro Carvalho Chehab b->m_dwSizeGetRing = SAA_DEVICE_BUFFERBLOCKSIZE; 45b285192aSMauro Carvalho Chehab 46b285192aSMauro Carvalho Chehab b->m_dwSetWritePos = ((u32)dev->intfdesc.BARLocation) + 47b285192aSMauro Carvalho Chehab (2 * sizeof(u64)); 48b285192aSMauro Carvalho Chehab b->m_dwSetReadPos = b->m_dwSetWritePos + (1 * sizeof(u32)); 49b285192aSMauro Carvalho Chehab 50b285192aSMauro Carvalho Chehab b->m_dwGetWritePos = b->m_dwSetWritePos + (2 * sizeof(u32)); 51b285192aSMauro Carvalho Chehab b->m_dwGetReadPos = b->m_dwSetWritePos + (3 * sizeof(u32)); 52b285192aSMauro Carvalho Chehab 53b285192aSMauro Carvalho Chehab return 0; 54b285192aSMauro Carvalho Chehab } 55b285192aSMauro Carvalho Chehab 56b285192aSMauro Carvalho Chehab void saa7164_bus_dump(struct saa7164_dev *dev) 57b285192aSMauro Carvalho Chehab { 58b285192aSMauro Carvalho Chehab struct tmComResBusInfo *b = &dev->bus; 59b285192aSMauro Carvalho Chehab 60b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "Dumping the bus structure:\n"); 61b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .type = %d\n", b->Type); 62b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .dev->bmmio = 0x%p\n", dev->bmmio); 63b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_wMaxReqSize = 0x%x\n", b->m_wMaxReqSize); 64b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_pdwSetRing = 0x%p\n", b->m_pdwSetRing); 65b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_dwSizeSetRing = 0x%x\n", b->m_dwSizeSetRing); 66b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_pdwGetRing = 0x%p\n", b->m_pdwGetRing); 67b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_dwSizeGetRing = 0x%x\n", b->m_dwSizeGetRing); 68b285192aSMauro Carvalho Chehab 69b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_dwSetReadPos = 0x%x (0x%08x)\n", 70b285192aSMauro Carvalho Chehab b->m_dwSetReadPos, saa7164_readl(b->m_dwSetReadPos)); 71b285192aSMauro Carvalho Chehab 72b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_dwSetWritePos = 0x%x (0x%08x)\n", 73b285192aSMauro Carvalho Chehab b->m_dwSetWritePos, saa7164_readl(b->m_dwSetWritePos)); 74b285192aSMauro Carvalho Chehab 75b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_dwGetReadPos = 0x%x (0x%08x)\n", 76b285192aSMauro Carvalho Chehab b->m_dwGetReadPos, saa7164_readl(b->m_dwGetReadPos)); 77b285192aSMauro Carvalho Chehab 78b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .m_dwGetWritePos = 0x%x (0x%08x)\n", 79b285192aSMauro Carvalho Chehab b->m_dwGetWritePos, saa7164_readl(b->m_dwGetWritePos)); 80b285192aSMauro Carvalho Chehab 81b285192aSMauro Carvalho Chehab } 82b285192aSMauro Carvalho Chehab 83b285192aSMauro Carvalho Chehab /* Intensionally throw a BUG() if the state of the message bus looks corrupt */ 84*5faf7db8SMauro Carvalho Chehab static void saa7164_bus_verify(struct saa7164_dev *dev) 85b285192aSMauro Carvalho Chehab { 86b285192aSMauro Carvalho Chehab struct tmComResBusInfo *b = &dev->bus; 87b285192aSMauro Carvalho Chehab int bug = 0; 88b285192aSMauro Carvalho Chehab 89b285192aSMauro Carvalho Chehab if (saa7164_readl(b->m_dwSetReadPos) > b->m_dwSizeSetRing) 90b285192aSMauro Carvalho Chehab bug++; 91b285192aSMauro Carvalho Chehab 92b285192aSMauro Carvalho Chehab if (saa7164_readl(b->m_dwSetWritePos) > b->m_dwSizeSetRing) 93b285192aSMauro Carvalho Chehab bug++; 94b285192aSMauro Carvalho Chehab 95b285192aSMauro Carvalho Chehab if (saa7164_readl(b->m_dwGetReadPos) > b->m_dwSizeGetRing) 96b285192aSMauro Carvalho Chehab bug++; 97b285192aSMauro Carvalho Chehab 98b285192aSMauro Carvalho Chehab if (saa7164_readl(b->m_dwGetWritePos) > b->m_dwSizeGetRing) 99b285192aSMauro Carvalho Chehab bug++; 100b285192aSMauro Carvalho Chehab 101b285192aSMauro Carvalho Chehab if (bug) { 102b285192aSMauro Carvalho Chehab saa_debug = 0xffff; /* Ensure we get the bus dump */ 103b285192aSMauro Carvalho Chehab saa7164_bus_dump(dev); 104b285192aSMauro Carvalho Chehab saa_debug = 1024; /* Ensure we get the bus dump */ 105b285192aSMauro Carvalho Chehab BUG(); 106b285192aSMauro Carvalho Chehab } 107b285192aSMauro Carvalho Chehab } 108b285192aSMauro Carvalho Chehab 109*5faf7db8SMauro Carvalho Chehab static void saa7164_bus_dumpmsg(struct saa7164_dev *dev, struct tmComResInfo *m, 110b285192aSMauro Carvalho Chehab void *buf) 111b285192aSMauro Carvalho Chehab { 112b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "Dumping msg structure:\n"); 113b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .id = %d\n", m->id); 114b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .flags = 0x%x\n", m->flags); 115b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .size = 0x%x\n", m->size); 116b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .command = 0x%x\n", m->command); 117b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .controlselector = 0x%x\n", m->controlselector); 118b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .seqno = %d\n", m->seqno); 119b285192aSMauro Carvalho Chehab if (buf) 120b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, " .buffer (ignored)\n"); 121b285192aSMauro Carvalho Chehab } 122b285192aSMauro Carvalho Chehab 123b285192aSMauro Carvalho Chehab /* 124b285192aSMauro Carvalho Chehab * Places a command or a response on the bus. The implementation does not 125b285192aSMauro Carvalho Chehab * know if it is a command or a response it just places the data on the 126b285192aSMauro Carvalho Chehab * bus depending on the bus information given in the struct tmComResBusInfo 127b285192aSMauro Carvalho Chehab * structure. If the command or response does not fit into the bus ring 128b285192aSMauro Carvalho Chehab * buffer it will be refused. 129b285192aSMauro Carvalho Chehab * 130b285192aSMauro Carvalho Chehab * Return Value: 131b285192aSMauro Carvalho Chehab * SAA_OK The function executed successfully. 132b285192aSMauro Carvalho Chehab * < 0 One or more members are not initialized. 133b285192aSMauro Carvalho Chehab */ 134b285192aSMauro Carvalho Chehab int saa7164_bus_set(struct saa7164_dev *dev, struct tmComResInfo* msg, 135b285192aSMauro Carvalho Chehab void *buf) 136b285192aSMauro Carvalho Chehab { 137b285192aSMauro Carvalho Chehab struct tmComResBusInfo *bus = &dev->bus; 138b285192aSMauro Carvalho Chehab u32 bytes_to_write, free_write_space, timeout, curr_srp, curr_swp; 139b285192aSMauro Carvalho Chehab u32 new_swp, space_rem; 140b285192aSMauro Carvalho Chehab int ret = SAA_ERR_BAD_PARAMETER; 141b285192aSMauro Carvalho Chehab 142b285192aSMauro Carvalho Chehab if (!msg) { 143b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() !msg\n", __func__); 144b285192aSMauro Carvalho Chehab return SAA_ERR_BAD_PARAMETER; 145b285192aSMauro Carvalho Chehab } 146b285192aSMauro Carvalho Chehab 147b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s()\n", __func__); 148b285192aSMauro Carvalho Chehab 149b285192aSMauro Carvalho Chehab saa7164_bus_verify(dev); 150b285192aSMauro Carvalho Chehab 151b285192aSMauro Carvalho Chehab msg->size = cpu_to_le16(msg->size); 152b285192aSMauro Carvalho Chehab msg->command = cpu_to_le32(msg->command); 153b285192aSMauro Carvalho Chehab msg->controlselector = cpu_to_le16(msg->controlselector); 154b285192aSMauro Carvalho Chehab 155b285192aSMauro Carvalho Chehab if (msg->size > dev->bus.m_wMaxReqSize) { 156b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() Exceeded dev->bus.m_wMaxReqSize\n", 157b285192aSMauro Carvalho Chehab __func__); 158b285192aSMauro Carvalho Chehab return SAA_ERR_BAD_PARAMETER; 159b285192aSMauro Carvalho Chehab } 160b285192aSMauro Carvalho Chehab 161b285192aSMauro Carvalho Chehab if ((msg->size > 0) && (buf == NULL)) { 162b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() Missing message buffer\n", __func__); 163b285192aSMauro Carvalho Chehab return SAA_ERR_BAD_PARAMETER; 164b285192aSMauro Carvalho Chehab } 165b285192aSMauro Carvalho Chehab 166b285192aSMauro Carvalho Chehab /* Lock the bus from any other access */ 167b285192aSMauro Carvalho Chehab mutex_lock(&bus->lock); 168b285192aSMauro Carvalho Chehab 169b285192aSMauro Carvalho Chehab bytes_to_write = sizeof(*msg) + msg->size; 170b285192aSMauro Carvalho Chehab free_write_space = 0; 171b285192aSMauro Carvalho Chehab timeout = SAA_BUS_TIMEOUT; 172b285192aSMauro Carvalho Chehab curr_srp = le32_to_cpu(saa7164_readl(bus->m_dwSetReadPos)); 173b285192aSMauro Carvalho Chehab curr_swp = le32_to_cpu(saa7164_readl(bus->m_dwSetWritePos)); 174b285192aSMauro Carvalho Chehab 175b285192aSMauro Carvalho Chehab /* Deal with ring wrapping issues */ 176b285192aSMauro Carvalho Chehab if (curr_srp > curr_swp) 177b285192aSMauro Carvalho Chehab /* Deal with the wrapped ring */ 178b285192aSMauro Carvalho Chehab free_write_space = curr_srp - curr_swp; 179b285192aSMauro Carvalho Chehab else 180b285192aSMauro Carvalho Chehab /* The ring has not wrapped yet */ 181b285192aSMauro Carvalho Chehab free_write_space = (curr_srp + bus->m_dwSizeSetRing) - curr_swp; 182b285192aSMauro Carvalho Chehab 183b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() bytes_to_write = %d\n", __func__, 184b285192aSMauro Carvalho Chehab bytes_to_write); 185b285192aSMauro Carvalho Chehab 186b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() free_write_space = %d\n", __func__, 187b285192aSMauro Carvalho Chehab free_write_space); 188b285192aSMauro Carvalho Chehab 189b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() curr_srp = %x\n", __func__, curr_srp); 190b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() curr_swp = %x\n", __func__, curr_swp); 191b285192aSMauro Carvalho Chehab 192b285192aSMauro Carvalho Chehab /* Process the msg and write the content onto the bus */ 193b285192aSMauro Carvalho Chehab while (bytes_to_write >= free_write_space) { 194b285192aSMauro Carvalho Chehab 195b285192aSMauro Carvalho Chehab if (timeout-- == 0) { 196b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() bus timeout\n", __func__); 197b285192aSMauro Carvalho Chehab ret = SAA_ERR_NO_RESOURCES; 198b285192aSMauro Carvalho Chehab goto out; 199b285192aSMauro Carvalho Chehab } 200b285192aSMauro Carvalho Chehab 201b285192aSMauro Carvalho Chehab /* TODO: Review this delay, efficient? */ 202b285192aSMauro Carvalho Chehab /* Wait, allowing the hardware fetch time */ 203b285192aSMauro Carvalho Chehab mdelay(1); 204b285192aSMauro Carvalho Chehab 205b285192aSMauro Carvalho Chehab /* Check the space usage again */ 206b285192aSMauro Carvalho Chehab curr_srp = le32_to_cpu(saa7164_readl(bus->m_dwSetReadPos)); 207b285192aSMauro Carvalho Chehab 208b285192aSMauro Carvalho Chehab /* Deal with ring wrapping issues */ 209b285192aSMauro Carvalho Chehab if (curr_srp > curr_swp) 210b285192aSMauro Carvalho Chehab /* Deal with the wrapped ring */ 211b285192aSMauro Carvalho Chehab free_write_space = curr_srp - curr_swp; 212b285192aSMauro Carvalho Chehab else 213b285192aSMauro Carvalho Chehab /* Read didn't wrap around the buffer */ 214b285192aSMauro Carvalho Chehab free_write_space = (curr_srp + bus->m_dwSizeSetRing) - 215b285192aSMauro Carvalho Chehab curr_swp; 216b285192aSMauro Carvalho Chehab 217b285192aSMauro Carvalho Chehab } 218b285192aSMauro Carvalho Chehab 219b285192aSMauro Carvalho Chehab /* Calculate the new write position */ 220b285192aSMauro Carvalho Chehab new_swp = curr_swp + bytes_to_write; 221b285192aSMauro Carvalho Chehab 222b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() new_swp = %x\n", __func__, new_swp); 223b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() bus->m_dwSizeSetRing = %x\n", __func__, 224b285192aSMauro Carvalho Chehab bus->m_dwSizeSetRing); 225b285192aSMauro Carvalho Chehab 226b285192aSMauro Carvalho Chehab /* Mental Note: line 462 tmmhComResBusPCIe.cpp */ 227b285192aSMauro Carvalho Chehab 228b285192aSMauro Carvalho Chehab /* Check if we're going to wrap again */ 229b285192aSMauro Carvalho Chehab if (new_swp > bus->m_dwSizeSetRing) { 230b285192aSMauro Carvalho Chehab 231b285192aSMauro Carvalho Chehab /* Ring wraps */ 232b285192aSMauro Carvalho Chehab new_swp -= bus->m_dwSizeSetRing; 233b285192aSMauro Carvalho Chehab 234b285192aSMauro Carvalho Chehab space_rem = bus->m_dwSizeSetRing - curr_swp; 235b285192aSMauro Carvalho Chehab 236b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() space_rem = %x\n", __func__, 237b285192aSMauro Carvalho Chehab space_rem); 238b285192aSMauro Carvalho Chehab 239b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() sizeof(*msg) = %d\n", __func__, 240b285192aSMauro Carvalho Chehab (u32)sizeof(*msg)); 241b285192aSMauro Carvalho Chehab 242b285192aSMauro Carvalho Chehab if (space_rem < sizeof(*msg)) { 243b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() tr4\n", __func__); 244b285192aSMauro Carvalho Chehab 245b285192aSMauro Carvalho Chehab /* Split the msg into pieces as the ring wraps */ 246b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + curr_swp, msg, space_rem); 247b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing, (u8 *)msg + space_rem, 248b285192aSMauro Carvalho Chehab sizeof(*msg) - space_rem); 249b285192aSMauro Carvalho Chehab 250b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + sizeof(*msg) - space_rem, 251b285192aSMauro Carvalho Chehab buf, msg->size); 252b285192aSMauro Carvalho Chehab 253b285192aSMauro Carvalho Chehab } else if (space_rem == sizeof(*msg)) { 254b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() tr5\n", __func__); 255b285192aSMauro Carvalho Chehab 256b285192aSMauro Carvalho Chehab /* Additional data at the beginning of the ring */ 257b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + curr_swp, msg, sizeof(*msg)); 258b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing, buf, msg->size); 259b285192aSMauro Carvalho Chehab 260b285192aSMauro Carvalho Chehab } else { 261b285192aSMauro Carvalho Chehab /* Additional data wraps around the ring */ 262b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + curr_swp, msg, sizeof(*msg)); 263b285192aSMauro Carvalho Chehab if (msg->size > 0) { 264b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + curr_swp + 265b285192aSMauro Carvalho Chehab sizeof(*msg), buf, space_rem - 266b285192aSMauro Carvalho Chehab sizeof(*msg)); 267b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing, (u8 *)buf + 268b285192aSMauro Carvalho Chehab space_rem - sizeof(*msg), 269b285192aSMauro Carvalho Chehab bytes_to_write - space_rem); 270b285192aSMauro Carvalho Chehab } 271b285192aSMauro Carvalho Chehab 272b285192aSMauro Carvalho Chehab } 273b285192aSMauro Carvalho Chehab 274b285192aSMauro Carvalho Chehab } /* (new_swp > bus->m_dwSizeSetRing) */ 275b285192aSMauro Carvalho Chehab else { 276b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() tr6\n", __func__); 277b285192aSMauro Carvalho Chehab 278b285192aSMauro Carvalho Chehab /* The ring buffer doesn't wrap, two simple copies */ 279b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + curr_swp, msg, sizeof(*msg)); 280b285192aSMauro Carvalho Chehab memcpy(bus->m_pdwSetRing + curr_swp + sizeof(*msg), buf, 281b285192aSMauro Carvalho Chehab msg->size); 282b285192aSMauro Carvalho Chehab } 283b285192aSMauro Carvalho Chehab 284b285192aSMauro Carvalho Chehab dprintk(DBGLVL_BUS, "%s() new_swp = %x\n", __func__, new_swp); 285b285192aSMauro Carvalho Chehab 286b285192aSMauro Carvalho Chehab /* Update the bus write position */ 287b285192aSMauro Carvalho Chehab saa7164_writel(bus->m_dwSetWritePos, cpu_to_le32(new_swp)); 288b285192aSMauro Carvalho Chehab ret = SAA_OK; 289b285192aSMauro Carvalho Chehab 290b285192aSMauro Carvalho Chehab out: 291b285192aSMauro Carvalho Chehab saa7164_bus_dump(dev); 292b285192aSMauro Carvalho Chehab mutex_unlock(&bus->lock); 293b285192aSMauro Carvalho Chehab saa7164_bus_verify(dev); 294b285192aSMauro Carvalho Chehab return ret; 295b285192aSMauro Carvalho Chehab } 296b285192aSMauro Carvalho Chehab 297b285192aSMauro Carvalho Chehab /* 298b285192aSMauro Carvalho Chehab * Receive a command or a response from the bus. The implementation does not 299b285192aSMauro Carvalho Chehab * know if it is a command or a response it simply dequeues the data, 300b285192aSMauro Carvalho Chehab * depending on the bus information given in the struct tmComResBusInfo 301b285192aSMauro Carvalho Chehab * structure. 302b285192aSMauro Carvalho Chehab * 303b285192aSMauro Carvalho Chehab * Return Value: 304b285192aSMauro Carvalho Chehab * 0 The function executed successfully. 305b285192aSMauro Carvalho Chehab * < 0 One or more members are not initialized. 306b285192aSMauro Carvalho Chehab */ 307b285192aSMauro Carvalho Chehab int saa7164_bus_get(struct saa7164_dev *dev, struct tmComResInfo* msg, 308b285192aSMauro Carvalho Chehab void *buf, int peekonly) 309b285192aSMauro Carvalho Chehab { 310b285192aSMauro Carvalho Chehab struct tmComResBusInfo *bus = &dev->bus; 311b285192aSMauro Carvalho Chehab u32 bytes_to_read, write_distance, curr_grp, curr_gwp, 312b285192aSMauro Carvalho Chehab new_grp, buf_size, space_rem; 313b285192aSMauro Carvalho Chehab struct tmComResInfo msg_tmp; 314b285192aSMauro Carvalho Chehab int ret = SAA_ERR_BAD_PARAMETER; 315b285192aSMauro Carvalho Chehab 316b285192aSMauro Carvalho Chehab saa7164_bus_verify(dev); 317b285192aSMauro Carvalho Chehab 318b285192aSMauro Carvalho Chehab if (msg == NULL) 319b285192aSMauro Carvalho Chehab return ret; 320b285192aSMauro Carvalho Chehab 321b285192aSMauro Carvalho Chehab if (msg->size > dev->bus.m_wMaxReqSize) { 322b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() Exceeded dev->bus.m_wMaxReqSize\n", 323b285192aSMauro Carvalho Chehab __func__); 324b285192aSMauro Carvalho Chehab return ret; 325b285192aSMauro Carvalho Chehab } 326b285192aSMauro Carvalho Chehab 327b285192aSMauro Carvalho Chehab if ((peekonly == 0) && (msg->size > 0) && (buf == NULL)) { 328b285192aSMauro Carvalho Chehab printk(KERN_ERR 329b285192aSMauro Carvalho Chehab "%s() Missing msg buf, size should be %d bytes\n", 330b285192aSMauro Carvalho Chehab __func__, msg->size); 331b285192aSMauro Carvalho Chehab return ret; 332b285192aSMauro Carvalho Chehab } 333b285192aSMauro Carvalho Chehab 334b285192aSMauro Carvalho Chehab mutex_lock(&bus->lock); 335b285192aSMauro Carvalho Chehab 336b285192aSMauro Carvalho Chehab /* Peek the bus to see if a msg exists, if it's not what we're expecting 337b285192aSMauro Carvalho Chehab * then return cleanly else read the message from the bus. 338b285192aSMauro Carvalho Chehab */ 339b285192aSMauro Carvalho Chehab curr_gwp = le32_to_cpu(saa7164_readl(bus->m_dwGetWritePos)); 340b285192aSMauro Carvalho Chehab curr_grp = le32_to_cpu(saa7164_readl(bus->m_dwGetReadPos)); 341b285192aSMauro Carvalho Chehab 342b285192aSMauro Carvalho Chehab if (curr_gwp == curr_grp) { 343b285192aSMauro Carvalho Chehab ret = SAA_ERR_EMPTY; 344b285192aSMauro Carvalho Chehab goto out; 345b285192aSMauro Carvalho Chehab } 346b285192aSMauro Carvalho Chehab 347b285192aSMauro Carvalho Chehab bytes_to_read = sizeof(*msg); 348b285192aSMauro Carvalho Chehab 349b285192aSMauro Carvalho Chehab /* Calculate write distance to current read position */ 350b285192aSMauro Carvalho Chehab write_distance = 0; 351b285192aSMauro Carvalho Chehab if (curr_gwp >= curr_grp) 352b285192aSMauro Carvalho Chehab /* Write doesn't wrap around the ring */ 353b285192aSMauro Carvalho Chehab write_distance = curr_gwp - curr_grp; 354b285192aSMauro Carvalho Chehab else 355b285192aSMauro Carvalho Chehab /* Write wraps around the ring */ 356b285192aSMauro Carvalho Chehab write_distance = curr_gwp + bus->m_dwSizeGetRing - curr_grp; 357b285192aSMauro Carvalho Chehab 358b285192aSMauro Carvalho Chehab if (bytes_to_read > write_distance) { 359b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() No message/response found\n", __func__); 360b285192aSMauro Carvalho Chehab ret = SAA_ERR_INVALID_COMMAND; 361b285192aSMauro Carvalho Chehab goto out; 362b285192aSMauro Carvalho Chehab } 363b285192aSMauro Carvalho Chehab 364b285192aSMauro Carvalho Chehab /* Calculate the new read position */ 365b285192aSMauro Carvalho Chehab new_grp = curr_grp + bytes_to_read; 366b285192aSMauro Carvalho Chehab if (new_grp > bus->m_dwSizeGetRing) { 367b285192aSMauro Carvalho Chehab 368b285192aSMauro Carvalho Chehab /* Ring wraps */ 369b285192aSMauro Carvalho Chehab new_grp -= bus->m_dwSizeGetRing; 370b285192aSMauro Carvalho Chehab space_rem = bus->m_dwSizeGetRing - curr_grp; 371b285192aSMauro Carvalho Chehab 372b285192aSMauro Carvalho Chehab memcpy(&msg_tmp, bus->m_pdwGetRing + curr_grp, space_rem); 373b285192aSMauro Carvalho Chehab memcpy((u8 *)&msg_tmp + space_rem, bus->m_pdwGetRing, 374b285192aSMauro Carvalho Chehab bytes_to_read - space_rem); 375b285192aSMauro Carvalho Chehab 376b285192aSMauro Carvalho Chehab } else { 377b285192aSMauro Carvalho Chehab /* No wrapping */ 378b285192aSMauro Carvalho Chehab memcpy(&msg_tmp, bus->m_pdwGetRing + curr_grp, bytes_to_read); 379b285192aSMauro Carvalho Chehab } 380b285192aSMauro Carvalho Chehab 381b285192aSMauro Carvalho Chehab /* No need to update the read positions, because this was a peek */ 382b285192aSMauro Carvalho Chehab /* If the caller specifically want to peek, return */ 383b285192aSMauro Carvalho Chehab if (peekonly) { 384b285192aSMauro Carvalho Chehab memcpy(msg, &msg_tmp, sizeof(*msg)); 385b285192aSMauro Carvalho Chehab goto peekout; 386b285192aSMauro Carvalho Chehab } 387b285192aSMauro Carvalho Chehab 388b285192aSMauro Carvalho Chehab /* Check if the command/response matches what is expected */ 389b285192aSMauro Carvalho Chehab if ((msg_tmp.id != msg->id) || (msg_tmp.command != msg->command) || 390b285192aSMauro Carvalho Chehab (msg_tmp.controlselector != msg->controlselector) || 391b285192aSMauro Carvalho Chehab (msg_tmp.seqno != msg->seqno) || (msg_tmp.size != msg->size)) { 392b285192aSMauro Carvalho Chehab 393b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() Unexpected msg miss-match\n", __func__); 394b285192aSMauro Carvalho Chehab saa7164_bus_dumpmsg(dev, msg, buf); 395b285192aSMauro Carvalho Chehab saa7164_bus_dumpmsg(dev, &msg_tmp, NULL); 396b285192aSMauro Carvalho Chehab ret = SAA_ERR_INVALID_COMMAND; 397b285192aSMauro Carvalho Chehab goto out; 398b285192aSMauro Carvalho Chehab } 399b285192aSMauro Carvalho Chehab 400b285192aSMauro Carvalho Chehab /* Get the actual command and response from the bus */ 401b285192aSMauro Carvalho Chehab buf_size = msg->size; 402b285192aSMauro Carvalho Chehab 403b285192aSMauro Carvalho Chehab bytes_to_read = sizeof(*msg) + msg->size; 404b285192aSMauro Carvalho Chehab /* Calculate write distance to current read position */ 405b285192aSMauro Carvalho Chehab write_distance = 0; 406b285192aSMauro Carvalho Chehab if (curr_gwp >= curr_grp) 407b285192aSMauro Carvalho Chehab /* Write doesn't wrap around the ring */ 408b285192aSMauro Carvalho Chehab write_distance = curr_gwp - curr_grp; 409b285192aSMauro Carvalho Chehab else 410b285192aSMauro Carvalho Chehab /* Write wraps around the ring */ 411b285192aSMauro Carvalho Chehab write_distance = curr_gwp + bus->m_dwSizeGetRing - curr_grp; 412b285192aSMauro Carvalho Chehab 413b285192aSMauro Carvalho Chehab if (bytes_to_read > write_distance) { 414b285192aSMauro Carvalho Chehab printk(KERN_ERR "%s() Invalid bus state, missing msg " 415b285192aSMauro Carvalho Chehab "or mangled ring, faulty H/W / bad code?\n", __func__); 416b285192aSMauro Carvalho Chehab ret = SAA_ERR_INVALID_COMMAND; 417b285192aSMauro Carvalho Chehab goto out; 418b285192aSMauro Carvalho Chehab } 419b285192aSMauro Carvalho Chehab 420b285192aSMauro Carvalho Chehab /* Calculate the new read position */ 421b285192aSMauro Carvalho Chehab new_grp = curr_grp + bytes_to_read; 422b285192aSMauro Carvalho Chehab if (new_grp > bus->m_dwSizeGetRing) { 423b285192aSMauro Carvalho Chehab 424b285192aSMauro Carvalho Chehab /* Ring wraps */ 425b285192aSMauro Carvalho Chehab new_grp -= bus->m_dwSizeGetRing; 426b285192aSMauro Carvalho Chehab space_rem = bus->m_dwSizeGetRing - curr_grp; 427b285192aSMauro Carvalho Chehab 428b285192aSMauro Carvalho Chehab if (space_rem < sizeof(*msg)) { 429b285192aSMauro Carvalho Chehab /* msg wraps around the ring */ 430b285192aSMauro Carvalho Chehab memcpy(msg, bus->m_pdwGetRing + curr_grp, space_rem); 431b285192aSMauro Carvalho Chehab memcpy((u8 *)msg + space_rem, bus->m_pdwGetRing, 432b285192aSMauro Carvalho Chehab sizeof(*msg) - space_rem); 433b285192aSMauro Carvalho Chehab if (buf) 434b285192aSMauro Carvalho Chehab memcpy(buf, bus->m_pdwGetRing + sizeof(*msg) - 435b285192aSMauro Carvalho Chehab space_rem, buf_size); 436b285192aSMauro Carvalho Chehab 437b285192aSMauro Carvalho Chehab } else if (space_rem == sizeof(*msg)) { 438b285192aSMauro Carvalho Chehab memcpy(msg, bus->m_pdwGetRing + curr_grp, sizeof(*msg)); 439b285192aSMauro Carvalho Chehab if (buf) 440b285192aSMauro Carvalho Chehab memcpy(buf, bus->m_pdwGetRing, buf_size); 441b285192aSMauro Carvalho Chehab } else { 442b285192aSMauro Carvalho Chehab /* Additional data wraps around the ring */ 443b285192aSMauro Carvalho Chehab memcpy(msg, bus->m_pdwGetRing + curr_grp, sizeof(*msg)); 444b285192aSMauro Carvalho Chehab if (buf) { 445b285192aSMauro Carvalho Chehab memcpy(buf, bus->m_pdwGetRing + curr_grp + 446b285192aSMauro Carvalho Chehab sizeof(*msg), space_rem - sizeof(*msg)); 447b285192aSMauro Carvalho Chehab memcpy(buf + space_rem - sizeof(*msg), 448b285192aSMauro Carvalho Chehab bus->m_pdwGetRing, bytes_to_read - 449b285192aSMauro Carvalho Chehab space_rem); 450b285192aSMauro Carvalho Chehab } 451b285192aSMauro Carvalho Chehab 452b285192aSMauro Carvalho Chehab } 453b285192aSMauro Carvalho Chehab 454b285192aSMauro Carvalho Chehab } else { 455b285192aSMauro Carvalho Chehab /* No wrapping */ 456b285192aSMauro Carvalho Chehab memcpy(msg, bus->m_pdwGetRing + curr_grp, sizeof(*msg)); 457b285192aSMauro Carvalho Chehab if (buf) 458b285192aSMauro Carvalho Chehab memcpy(buf, bus->m_pdwGetRing + curr_grp + sizeof(*msg), 459b285192aSMauro Carvalho Chehab buf_size); 460b285192aSMauro Carvalho Chehab } 461b285192aSMauro Carvalho Chehab 462b285192aSMauro Carvalho Chehab /* Update the read positions, adjusting the ring */ 463b285192aSMauro Carvalho Chehab saa7164_writel(bus->m_dwGetReadPos, cpu_to_le32(new_grp)); 464b285192aSMauro Carvalho Chehab 465b285192aSMauro Carvalho Chehab peekout: 466b285192aSMauro Carvalho Chehab msg->size = le16_to_cpu(msg->size); 467b285192aSMauro Carvalho Chehab msg->command = le32_to_cpu(msg->command); 468b285192aSMauro Carvalho Chehab msg->controlselector = le16_to_cpu(msg->controlselector); 469b285192aSMauro Carvalho Chehab ret = SAA_OK; 470b285192aSMauro Carvalho Chehab out: 471b285192aSMauro Carvalho Chehab mutex_unlock(&bus->lock); 472b285192aSMauro Carvalho Chehab saa7164_bus_verify(dev); 473b285192aSMauro Carvalho Chehab return ret; 474b285192aSMauro Carvalho Chehab } 475b285192aSMauro Carvalho Chehab 476