10c0d06caSMauro Carvalho Chehab /* 20c0d06caSMauro Carvalho Chehab * 30c0d06caSMauro Carvalho Chehab * 40c0d06caSMauro Carvalho Chehab * Copyright (C) 2005 Mike Isely <isely@pobox.com> 50c0d06caSMauro Carvalho Chehab * 60c0d06caSMauro Carvalho Chehab * This program is free software; you can redistribute it and/or modify 70c0d06caSMauro Carvalho Chehab * it under the terms of the GNU General Public License as published by 80c0d06caSMauro Carvalho Chehab * the Free Software Foundation; either version 2 of the License 90c0d06caSMauro Carvalho Chehab * 100c0d06caSMauro Carvalho Chehab * This program is distributed in the hope that it will be useful, 110c0d06caSMauro Carvalho Chehab * but WITHOUT ANY WARRANTY; without even the implied warranty of 120c0d06caSMauro Carvalho Chehab * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 130c0d06caSMauro Carvalho Chehab * GNU General Public License for more details. 140c0d06caSMauro Carvalho Chehab * 150c0d06caSMauro Carvalho Chehab * You should have received a copy of the GNU General Public License 160c0d06caSMauro Carvalho Chehab * along with this program; if not, write to the Free Software 170c0d06caSMauro Carvalho Chehab * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 180c0d06caSMauro Carvalho Chehab * 190c0d06caSMauro Carvalho Chehab */ 200c0d06caSMauro Carvalho Chehab 210c0d06caSMauro Carvalho Chehab #include "pvrusb2-io.h" 220c0d06caSMauro Carvalho Chehab #include "pvrusb2-debug.h" 230c0d06caSMauro Carvalho Chehab #include <linux/errno.h> 240c0d06caSMauro Carvalho Chehab #include <linux/string.h> 250c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 260c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 270c0d06caSMauro Carvalho Chehab 280c0d06caSMauro Carvalho Chehab static const char *pvr2_buffer_state_decode(enum pvr2_buffer_state); 290c0d06caSMauro Carvalho Chehab 300c0d06caSMauro Carvalho Chehab #define BUFFER_SIG 0x47653271 310c0d06caSMauro Carvalho Chehab 320c0d06caSMauro Carvalho Chehab // #define SANITY_CHECK_BUFFERS 330c0d06caSMauro Carvalho Chehab 340c0d06caSMauro Carvalho Chehab 350c0d06caSMauro Carvalho Chehab #ifdef SANITY_CHECK_BUFFERS 360c0d06caSMauro Carvalho Chehab #define BUFFER_CHECK(bp) do { \ 370c0d06caSMauro Carvalho Chehab if ((bp)->signature != BUFFER_SIG) { \ 380c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_ERROR_LEGS, \ 390c0d06caSMauro Carvalho Chehab "Buffer %p is bad at %s:%d", \ 400c0d06caSMauro Carvalho Chehab (bp),__FILE__,__LINE__); \ 410c0d06caSMauro Carvalho Chehab pvr2_buffer_describe(bp,"BadSig"); \ 420c0d06caSMauro Carvalho Chehab BUG(); \ 430c0d06caSMauro Carvalho Chehab } \ 440c0d06caSMauro Carvalho Chehab } while (0) 450c0d06caSMauro Carvalho Chehab #else 460c0d06caSMauro Carvalho Chehab #define BUFFER_CHECK(bp) do {} while(0) 470c0d06caSMauro Carvalho Chehab #endif 480c0d06caSMauro Carvalho Chehab 490c0d06caSMauro Carvalho Chehab struct pvr2_stream { 500c0d06caSMauro Carvalho Chehab /* Buffers queued for reading */ 510c0d06caSMauro Carvalho Chehab struct list_head queued_list; 520c0d06caSMauro Carvalho Chehab unsigned int q_count; 530c0d06caSMauro Carvalho Chehab unsigned int q_bcount; 540c0d06caSMauro Carvalho Chehab /* Buffers with retrieved data */ 550c0d06caSMauro Carvalho Chehab struct list_head ready_list; 560c0d06caSMauro Carvalho Chehab unsigned int r_count; 570c0d06caSMauro Carvalho Chehab unsigned int r_bcount; 580c0d06caSMauro Carvalho Chehab /* Buffers available for use */ 590c0d06caSMauro Carvalho Chehab struct list_head idle_list; 600c0d06caSMauro Carvalho Chehab unsigned int i_count; 610c0d06caSMauro Carvalho Chehab unsigned int i_bcount; 620c0d06caSMauro Carvalho Chehab /* Pointers to all buffers */ 630c0d06caSMauro Carvalho Chehab struct pvr2_buffer **buffers; 640c0d06caSMauro Carvalho Chehab /* Array size of buffers */ 650c0d06caSMauro Carvalho Chehab unsigned int buffer_slot_count; 660c0d06caSMauro Carvalho Chehab /* Total buffers actually in circulation */ 670c0d06caSMauro Carvalho Chehab unsigned int buffer_total_count; 680c0d06caSMauro Carvalho Chehab /* Designed number of buffers to be in circulation */ 690c0d06caSMauro Carvalho Chehab unsigned int buffer_target_count; 700c0d06caSMauro Carvalho Chehab /* Executed when ready list become non-empty */ 710c0d06caSMauro Carvalho Chehab pvr2_stream_callback callback_func; 720c0d06caSMauro Carvalho Chehab void *callback_data; 730c0d06caSMauro Carvalho Chehab /* Context for transfer endpoint */ 740c0d06caSMauro Carvalho Chehab struct usb_device *dev; 750c0d06caSMauro Carvalho Chehab int endpoint; 760c0d06caSMauro Carvalho Chehab /* Overhead for mutex enforcement */ 770c0d06caSMauro Carvalho Chehab spinlock_t list_lock; 780c0d06caSMauro Carvalho Chehab struct mutex mutex; 790c0d06caSMauro Carvalho Chehab /* Tracking state for tolerating errors */ 800c0d06caSMauro Carvalho Chehab unsigned int fail_count; 810c0d06caSMauro Carvalho Chehab unsigned int fail_tolerance; 820c0d06caSMauro Carvalho Chehab 830c0d06caSMauro Carvalho Chehab unsigned int buffers_processed; 840c0d06caSMauro Carvalho Chehab unsigned int buffers_failed; 850c0d06caSMauro Carvalho Chehab unsigned int bytes_processed; 860c0d06caSMauro Carvalho Chehab }; 870c0d06caSMauro Carvalho Chehab 880c0d06caSMauro Carvalho Chehab struct pvr2_buffer { 890c0d06caSMauro Carvalho Chehab int id; 900c0d06caSMauro Carvalho Chehab int signature; 910c0d06caSMauro Carvalho Chehab enum pvr2_buffer_state state; 920c0d06caSMauro Carvalho Chehab void *ptr; /* Pointer to storage area */ 930c0d06caSMauro Carvalho Chehab unsigned int max_count; /* Size of storage area */ 940c0d06caSMauro Carvalho Chehab unsigned int used_count; /* Amount of valid data in storage area */ 950c0d06caSMauro Carvalho Chehab int status; /* Transfer result status */ 960c0d06caSMauro Carvalho Chehab struct pvr2_stream *stream; 970c0d06caSMauro Carvalho Chehab struct list_head list_overhead; 980c0d06caSMauro Carvalho Chehab struct urb *purb; 990c0d06caSMauro Carvalho Chehab }; 1000c0d06caSMauro Carvalho Chehab 1010c0d06caSMauro Carvalho Chehab static const char *pvr2_buffer_state_decode(enum pvr2_buffer_state st) 1020c0d06caSMauro Carvalho Chehab { 1030c0d06caSMauro Carvalho Chehab switch (st) { 1040c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_none: return "none"; 1050c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_idle: return "idle"; 1060c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_queued: return "queued"; 1070c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_ready: return "ready"; 1080c0d06caSMauro Carvalho Chehab } 1090c0d06caSMauro Carvalho Chehab return "unknown"; 1100c0d06caSMauro Carvalho Chehab } 1110c0d06caSMauro Carvalho Chehab 1120c0d06caSMauro Carvalho Chehab #ifdef SANITY_CHECK_BUFFERS 1130c0d06caSMauro Carvalho Chehab static void pvr2_buffer_describe(struct pvr2_buffer *bp,const char *msg) 1140c0d06caSMauro Carvalho Chehab { 1150c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_INFO, 116*96292c89SMauro Carvalho Chehab "buffer%s%s %p state=%s id=%d status=%d stream=%p purb=%p sig=0x%x", 1170c0d06caSMauro Carvalho Chehab (msg ? " " : ""), 1180c0d06caSMauro Carvalho Chehab (msg ? msg : ""), 1190c0d06caSMauro Carvalho Chehab bp, 1200c0d06caSMauro Carvalho Chehab (bp ? pvr2_buffer_state_decode(bp->state) : "(invalid)"), 1210c0d06caSMauro Carvalho Chehab (bp ? bp->id : 0), 1220c0d06caSMauro Carvalho Chehab (bp ? bp->status : 0), 1230c0d06caSMauro Carvalho Chehab (bp ? bp->stream : NULL), 1240c0d06caSMauro Carvalho Chehab (bp ? bp->purb : NULL), 1250c0d06caSMauro Carvalho Chehab (bp ? bp->signature : 0)); 1260c0d06caSMauro Carvalho Chehab } 1270c0d06caSMauro Carvalho Chehab #endif /* SANITY_CHECK_BUFFERS */ 1280c0d06caSMauro Carvalho Chehab 1290c0d06caSMauro Carvalho Chehab static void pvr2_buffer_remove(struct pvr2_buffer *bp) 1300c0d06caSMauro Carvalho Chehab { 1310c0d06caSMauro Carvalho Chehab unsigned int *cnt; 1320c0d06caSMauro Carvalho Chehab unsigned int *bcnt; 1330c0d06caSMauro Carvalho Chehab unsigned int ccnt; 1340c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp = bp->stream; 1350c0d06caSMauro Carvalho Chehab switch (bp->state) { 1360c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_idle: 1370c0d06caSMauro Carvalho Chehab cnt = &sp->i_count; 1380c0d06caSMauro Carvalho Chehab bcnt = &sp->i_bcount; 1390c0d06caSMauro Carvalho Chehab ccnt = bp->max_count; 1400c0d06caSMauro Carvalho Chehab break; 1410c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_queued: 1420c0d06caSMauro Carvalho Chehab cnt = &sp->q_count; 1430c0d06caSMauro Carvalho Chehab bcnt = &sp->q_bcount; 1440c0d06caSMauro Carvalho Chehab ccnt = bp->max_count; 1450c0d06caSMauro Carvalho Chehab break; 1460c0d06caSMauro Carvalho Chehab case pvr2_buffer_state_ready: 1470c0d06caSMauro Carvalho Chehab cnt = &sp->r_count; 1480c0d06caSMauro Carvalho Chehab bcnt = &sp->r_bcount; 1490c0d06caSMauro Carvalho Chehab ccnt = bp->used_count; 1500c0d06caSMauro Carvalho Chehab break; 1510c0d06caSMauro Carvalho Chehab default: 1520c0d06caSMauro Carvalho Chehab return; 1530c0d06caSMauro Carvalho Chehab } 1540c0d06caSMauro Carvalho Chehab list_del_init(&bp->list_overhead); 1550c0d06caSMauro Carvalho Chehab (*cnt)--; 1560c0d06caSMauro Carvalho Chehab (*bcnt) -= ccnt; 1570c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 158*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferPool %8s dec cap=%07d cnt=%02d", 1590c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state),*bcnt,*cnt); 1600c0d06caSMauro Carvalho Chehab bp->state = pvr2_buffer_state_none; 1610c0d06caSMauro Carvalho Chehab } 1620c0d06caSMauro Carvalho Chehab 1630c0d06caSMauro Carvalho Chehab static void pvr2_buffer_set_none(struct pvr2_buffer *bp) 1640c0d06caSMauro Carvalho Chehab { 1650c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 1660c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 1670c0d06caSMauro Carvalho Chehab BUFFER_CHECK(bp); 1680c0d06caSMauro Carvalho Chehab sp = bp->stream; 1690c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 1700c0d06caSMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferState %p %6s --> %6s", 1710c0d06caSMauro Carvalho Chehab bp, 1720c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 1730c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(pvr2_buffer_state_none)); 1740c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 1750c0d06caSMauro Carvalho Chehab pvr2_buffer_remove(bp); 1760c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 1770c0d06caSMauro Carvalho Chehab } 1780c0d06caSMauro Carvalho Chehab 1790c0d06caSMauro Carvalho Chehab static int pvr2_buffer_set_ready(struct pvr2_buffer *bp) 1800c0d06caSMauro Carvalho Chehab { 1810c0d06caSMauro Carvalho Chehab int fl; 1820c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 1830c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 1840c0d06caSMauro Carvalho Chehab BUFFER_CHECK(bp); 1850c0d06caSMauro Carvalho Chehab sp = bp->stream; 1860c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 1870c0d06caSMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferState %p %6s --> %6s", 1880c0d06caSMauro Carvalho Chehab bp, 1890c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 1900c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(pvr2_buffer_state_ready)); 1910c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 1920c0d06caSMauro Carvalho Chehab fl = (sp->r_count == 0); 1930c0d06caSMauro Carvalho Chehab pvr2_buffer_remove(bp); 1940c0d06caSMauro Carvalho Chehab list_add_tail(&bp->list_overhead,&sp->ready_list); 1950c0d06caSMauro Carvalho Chehab bp->state = pvr2_buffer_state_ready; 1960c0d06caSMauro Carvalho Chehab (sp->r_count)++; 1970c0d06caSMauro Carvalho Chehab sp->r_bcount += bp->used_count; 1980c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 199*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferPool %8s inc cap=%07d cnt=%02d", 2000c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 2010c0d06caSMauro Carvalho Chehab sp->r_bcount,sp->r_count); 2020c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 2030c0d06caSMauro Carvalho Chehab return fl; 2040c0d06caSMauro Carvalho Chehab } 2050c0d06caSMauro Carvalho Chehab 2060c0d06caSMauro Carvalho Chehab static void pvr2_buffer_set_idle(struct pvr2_buffer *bp) 2070c0d06caSMauro Carvalho Chehab { 2080c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 2090c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 2100c0d06caSMauro Carvalho Chehab BUFFER_CHECK(bp); 2110c0d06caSMauro Carvalho Chehab sp = bp->stream; 2120c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 2130c0d06caSMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferState %p %6s --> %6s", 2140c0d06caSMauro Carvalho Chehab bp, 2150c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 2160c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(pvr2_buffer_state_idle)); 2170c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 2180c0d06caSMauro Carvalho Chehab pvr2_buffer_remove(bp); 2190c0d06caSMauro Carvalho Chehab list_add_tail(&bp->list_overhead,&sp->idle_list); 2200c0d06caSMauro Carvalho Chehab bp->state = pvr2_buffer_state_idle; 2210c0d06caSMauro Carvalho Chehab (sp->i_count)++; 2220c0d06caSMauro Carvalho Chehab sp->i_bcount += bp->max_count; 2230c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 224*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferPool %8s inc cap=%07d cnt=%02d", 2250c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 2260c0d06caSMauro Carvalho Chehab sp->i_bcount,sp->i_count); 2270c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 2280c0d06caSMauro Carvalho Chehab } 2290c0d06caSMauro Carvalho Chehab 2300c0d06caSMauro Carvalho Chehab static void pvr2_buffer_set_queued(struct pvr2_buffer *bp) 2310c0d06caSMauro Carvalho Chehab { 2320c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 2330c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 2340c0d06caSMauro Carvalho Chehab BUFFER_CHECK(bp); 2350c0d06caSMauro Carvalho Chehab sp = bp->stream; 2360c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 2370c0d06caSMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferState %p %6s --> %6s", 2380c0d06caSMauro Carvalho Chehab bp, 2390c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 2400c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(pvr2_buffer_state_queued)); 2410c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 2420c0d06caSMauro Carvalho Chehab pvr2_buffer_remove(bp); 2430c0d06caSMauro Carvalho Chehab list_add_tail(&bp->list_overhead,&sp->queued_list); 2440c0d06caSMauro Carvalho Chehab bp->state = pvr2_buffer_state_queued; 2450c0d06caSMauro Carvalho Chehab (sp->q_count)++; 2460c0d06caSMauro Carvalho Chehab sp->q_bcount += bp->max_count; 2470c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 248*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferPool %8s inc cap=%07d cnt=%02d", 2490c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode(bp->state), 2500c0d06caSMauro Carvalho Chehab sp->q_bcount,sp->q_count); 2510c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 2520c0d06caSMauro Carvalho Chehab } 2530c0d06caSMauro Carvalho Chehab 2540c0d06caSMauro Carvalho Chehab static void pvr2_buffer_wipe(struct pvr2_buffer *bp) 2550c0d06caSMauro Carvalho Chehab { 2560c0d06caSMauro Carvalho Chehab if (bp->state == pvr2_buffer_state_queued) { 2570c0d06caSMauro Carvalho Chehab usb_kill_urb(bp->purb); 2580c0d06caSMauro Carvalho Chehab } 2590c0d06caSMauro Carvalho Chehab } 2600c0d06caSMauro Carvalho Chehab 2610c0d06caSMauro Carvalho Chehab static int pvr2_buffer_init(struct pvr2_buffer *bp, 2620c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp, 2630c0d06caSMauro Carvalho Chehab unsigned int id) 2640c0d06caSMauro Carvalho Chehab { 2650c0d06caSMauro Carvalho Chehab memset(bp,0,sizeof(*bp)); 2660c0d06caSMauro Carvalho Chehab bp->signature = BUFFER_SIG; 2670c0d06caSMauro Carvalho Chehab bp->id = id; 2680c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_POOL, 2690c0d06caSMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferInit %p stream=%p",bp,sp); 2700c0d06caSMauro Carvalho Chehab bp->stream = sp; 2710c0d06caSMauro Carvalho Chehab bp->state = pvr2_buffer_state_none; 2720c0d06caSMauro Carvalho Chehab INIT_LIST_HEAD(&bp->list_overhead); 2730c0d06caSMauro Carvalho Chehab bp->purb = usb_alloc_urb(0,GFP_KERNEL); 2740c0d06caSMauro Carvalho Chehab if (! bp->purb) return -ENOMEM; 2750c0d06caSMauro Carvalho Chehab #ifdef SANITY_CHECK_BUFFERS 2760c0d06caSMauro Carvalho Chehab pvr2_buffer_describe(bp,"create"); 2770c0d06caSMauro Carvalho Chehab #endif 2780c0d06caSMauro Carvalho Chehab return 0; 2790c0d06caSMauro Carvalho Chehab } 2800c0d06caSMauro Carvalho Chehab 2810c0d06caSMauro Carvalho Chehab static void pvr2_buffer_done(struct pvr2_buffer *bp) 2820c0d06caSMauro Carvalho Chehab { 2830c0d06caSMauro Carvalho Chehab #ifdef SANITY_CHECK_BUFFERS 2840c0d06caSMauro Carvalho Chehab pvr2_buffer_describe(bp,"delete"); 2850c0d06caSMauro Carvalho Chehab #endif 2860c0d06caSMauro Carvalho Chehab pvr2_buffer_wipe(bp); 2870c0d06caSMauro Carvalho Chehab pvr2_buffer_set_none(bp); 2880c0d06caSMauro Carvalho Chehab bp->signature = 0; 2890c0d06caSMauro Carvalho Chehab bp->stream = NULL; 2900c0d06caSMauro Carvalho Chehab usb_free_urb(bp->purb); 291*96292c89SMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_POOL, "/*---TRACE_FLOW---*/ bufferDone %p", 292*96292c89SMauro Carvalho Chehab bp); 2930c0d06caSMauro Carvalho Chehab } 2940c0d06caSMauro Carvalho Chehab 2950c0d06caSMauro Carvalho Chehab static int pvr2_stream_buffer_count(struct pvr2_stream *sp,unsigned int cnt) 2960c0d06caSMauro Carvalho Chehab { 2970c0d06caSMauro Carvalho Chehab int ret; 2980c0d06caSMauro Carvalho Chehab unsigned int scnt; 2990c0d06caSMauro Carvalho Chehab 3000c0d06caSMauro Carvalho Chehab /* Allocate buffers pointer array in multiples of 32 entries */ 3010c0d06caSMauro Carvalho Chehab if (cnt == sp->buffer_total_count) return 0; 3020c0d06caSMauro Carvalho Chehab 3030c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_POOL, 304*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ poolResize stream=%p cur=%d adj=%+d", 3050c0d06caSMauro Carvalho Chehab sp, 3060c0d06caSMauro Carvalho Chehab sp->buffer_total_count, 3070c0d06caSMauro Carvalho Chehab cnt-sp->buffer_total_count); 3080c0d06caSMauro Carvalho Chehab 3090c0d06caSMauro Carvalho Chehab scnt = cnt & ~0x1f; 3100c0d06caSMauro Carvalho Chehab if (cnt > scnt) scnt += 0x20; 3110c0d06caSMauro Carvalho Chehab 3120c0d06caSMauro Carvalho Chehab if (cnt > sp->buffer_total_count) { 3130c0d06caSMauro Carvalho Chehab if (scnt > sp->buffer_slot_count) { 3140c0d06caSMauro Carvalho Chehab struct pvr2_buffer **nb; 3150c0d06caSMauro Carvalho Chehab nb = kmalloc(scnt * sizeof(*nb),GFP_KERNEL); 3160c0d06caSMauro Carvalho Chehab if (!nb) return -ENOMEM; 3170c0d06caSMauro Carvalho Chehab if (sp->buffer_slot_count) { 3180c0d06caSMauro Carvalho Chehab memcpy(nb,sp->buffers, 3190c0d06caSMauro Carvalho Chehab sp->buffer_slot_count * sizeof(*nb)); 3200c0d06caSMauro Carvalho Chehab kfree(sp->buffers); 3210c0d06caSMauro Carvalho Chehab } 3220c0d06caSMauro Carvalho Chehab sp->buffers = nb; 3230c0d06caSMauro Carvalho Chehab sp->buffer_slot_count = scnt; 3240c0d06caSMauro Carvalho Chehab } 3250c0d06caSMauro Carvalho Chehab while (sp->buffer_total_count < cnt) { 3260c0d06caSMauro Carvalho Chehab struct pvr2_buffer *bp; 3270c0d06caSMauro Carvalho Chehab bp = kmalloc(sizeof(*bp),GFP_KERNEL); 3280c0d06caSMauro Carvalho Chehab if (!bp) return -ENOMEM; 3290c0d06caSMauro Carvalho Chehab ret = pvr2_buffer_init(bp,sp,sp->buffer_total_count); 3300c0d06caSMauro Carvalho Chehab if (ret) { 3310c0d06caSMauro Carvalho Chehab kfree(bp); 3320c0d06caSMauro Carvalho Chehab return -ENOMEM; 3330c0d06caSMauro Carvalho Chehab } 3340c0d06caSMauro Carvalho Chehab sp->buffers[sp->buffer_total_count] = bp; 3350c0d06caSMauro Carvalho Chehab (sp->buffer_total_count)++; 3360c0d06caSMauro Carvalho Chehab pvr2_buffer_set_idle(bp); 3370c0d06caSMauro Carvalho Chehab } 3380c0d06caSMauro Carvalho Chehab } else { 3390c0d06caSMauro Carvalho Chehab while (sp->buffer_total_count > cnt) { 3400c0d06caSMauro Carvalho Chehab struct pvr2_buffer *bp; 3410c0d06caSMauro Carvalho Chehab bp = sp->buffers[sp->buffer_total_count - 1]; 3420c0d06caSMauro Carvalho Chehab /* Paranoia */ 3430c0d06caSMauro Carvalho Chehab sp->buffers[sp->buffer_total_count - 1] = NULL; 3440c0d06caSMauro Carvalho Chehab (sp->buffer_total_count)--; 3450c0d06caSMauro Carvalho Chehab pvr2_buffer_done(bp); 3460c0d06caSMauro Carvalho Chehab kfree(bp); 3470c0d06caSMauro Carvalho Chehab } 3480c0d06caSMauro Carvalho Chehab if (scnt < sp->buffer_slot_count) { 3490c0d06caSMauro Carvalho Chehab struct pvr2_buffer **nb = NULL; 3500c0d06caSMauro Carvalho Chehab if (scnt) { 35107342664SThomas Meyer nb = kmemdup(sp->buffers, scnt * sizeof(*nb), 35207342664SThomas Meyer GFP_KERNEL); 3530c0d06caSMauro Carvalho Chehab if (!nb) return -ENOMEM; 3540c0d06caSMauro Carvalho Chehab } 3550c0d06caSMauro Carvalho Chehab kfree(sp->buffers); 3560c0d06caSMauro Carvalho Chehab sp->buffers = nb; 3570c0d06caSMauro Carvalho Chehab sp->buffer_slot_count = scnt; 3580c0d06caSMauro Carvalho Chehab } 3590c0d06caSMauro Carvalho Chehab } 3600c0d06caSMauro Carvalho Chehab return 0; 3610c0d06caSMauro Carvalho Chehab } 3620c0d06caSMauro Carvalho Chehab 3630c0d06caSMauro Carvalho Chehab static int pvr2_stream_achieve_buffer_count(struct pvr2_stream *sp) 3640c0d06caSMauro Carvalho Chehab { 3650c0d06caSMauro Carvalho Chehab struct pvr2_buffer *bp; 3660c0d06caSMauro Carvalho Chehab unsigned int cnt; 3670c0d06caSMauro Carvalho Chehab 3680c0d06caSMauro Carvalho Chehab if (sp->buffer_total_count == sp->buffer_target_count) return 0; 3690c0d06caSMauro Carvalho Chehab 3700c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_POOL, 371*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ poolCheck stream=%p cur=%d tgt=%d", 3720c0d06caSMauro Carvalho Chehab sp,sp->buffer_total_count,sp->buffer_target_count); 3730c0d06caSMauro Carvalho Chehab 3740c0d06caSMauro Carvalho Chehab if (sp->buffer_total_count < sp->buffer_target_count) { 3750c0d06caSMauro Carvalho Chehab return pvr2_stream_buffer_count(sp,sp->buffer_target_count); 3760c0d06caSMauro Carvalho Chehab } 3770c0d06caSMauro Carvalho Chehab 3780c0d06caSMauro Carvalho Chehab cnt = 0; 3790c0d06caSMauro Carvalho Chehab while ((sp->buffer_total_count - cnt) > sp->buffer_target_count) { 3800c0d06caSMauro Carvalho Chehab bp = sp->buffers[sp->buffer_total_count - (cnt + 1)]; 3810c0d06caSMauro Carvalho Chehab if (bp->state != pvr2_buffer_state_idle) break; 3820c0d06caSMauro Carvalho Chehab cnt++; 3830c0d06caSMauro Carvalho Chehab } 3840c0d06caSMauro Carvalho Chehab if (cnt) { 3850c0d06caSMauro Carvalho Chehab pvr2_stream_buffer_count(sp,sp->buffer_total_count - cnt); 3860c0d06caSMauro Carvalho Chehab } 3870c0d06caSMauro Carvalho Chehab 3880c0d06caSMauro Carvalho Chehab return 0; 3890c0d06caSMauro Carvalho Chehab } 3900c0d06caSMauro Carvalho Chehab 3910c0d06caSMauro Carvalho Chehab static void pvr2_stream_internal_flush(struct pvr2_stream *sp) 3920c0d06caSMauro Carvalho Chehab { 3930c0d06caSMauro Carvalho Chehab struct list_head *lp; 3940c0d06caSMauro Carvalho Chehab struct pvr2_buffer *bp1; 3950c0d06caSMauro Carvalho Chehab while ((lp = sp->queued_list.next) != &sp->queued_list) { 3960c0d06caSMauro Carvalho Chehab bp1 = list_entry(lp,struct pvr2_buffer,list_overhead); 3970c0d06caSMauro Carvalho Chehab pvr2_buffer_wipe(bp1); 3980c0d06caSMauro Carvalho Chehab /* At this point, we should be guaranteed that no 3990c0d06caSMauro Carvalho Chehab completion callback may happen on this buffer. But it's 4000c0d06caSMauro Carvalho Chehab possible that it might have completed after we noticed 4010c0d06caSMauro Carvalho Chehab it but before we wiped it. So double check its status 4020c0d06caSMauro Carvalho Chehab here first. */ 4030c0d06caSMauro Carvalho Chehab if (bp1->state != pvr2_buffer_state_queued) continue; 4040c0d06caSMauro Carvalho Chehab pvr2_buffer_set_idle(bp1); 4050c0d06caSMauro Carvalho Chehab } 4060c0d06caSMauro Carvalho Chehab if (sp->buffer_total_count != sp->buffer_target_count) { 4070c0d06caSMauro Carvalho Chehab pvr2_stream_achieve_buffer_count(sp); 4080c0d06caSMauro Carvalho Chehab } 4090c0d06caSMauro Carvalho Chehab } 4100c0d06caSMauro Carvalho Chehab 4110c0d06caSMauro Carvalho Chehab static void pvr2_stream_init(struct pvr2_stream *sp) 4120c0d06caSMauro Carvalho Chehab { 4130c0d06caSMauro Carvalho Chehab spin_lock_init(&sp->list_lock); 4140c0d06caSMauro Carvalho Chehab mutex_init(&sp->mutex); 4150c0d06caSMauro Carvalho Chehab INIT_LIST_HEAD(&sp->queued_list); 4160c0d06caSMauro Carvalho Chehab INIT_LIST_HEAD(&sp->ready_list); 4170c0d06caSMauro Carvalho Chehab INIT_LIST_HEAD(&sp->idle_list); 4180c0d06caSMauro Carvalho Chehab } 4190c0d06caSMauro Carvalho Chehab 4200c0d06caSMauro Carvalho Chehab static void pvr2_stream_done(struct pvr2_stream *sp) 4210c0d06caSMauro Carvalho Chehab { 4220c0d06caSMauro Carvalho Chehab mutex_lock(&sp->mutex); do { 4230c0d06caSMauro Carvalho Chehab pvr2_stream_internal_flush(sp); 4240c0d06caSMauro Carvalho Chehab pvr2_stream_buffer_count(sp,0); 4250c0d06caSMauro Carvalho Chehab } while (0); mutex_unlock(&sp->mutex); 4260c0d06caSMauro Carvalho Chehab } 4270c0d06caSMauro Carvalho Chehab 4280c0d06caSMauro Carvalho Chehab static void buffer_complete(struct urb *urb) 4290c0d06caSMauro Carvalho Chehab { 4300c0d06caSMauro Carvalho Chehab struct pvr2_buffer *bp = urb->context; 4310c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 4320c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 4330c0d06caSMauro Carvalho Chehab BUFFER_CHECK(bp); 4340c0d06caSMauro Carvalho Chehab sp = bp->stream; 4350c0d06caSMauro Carvalho Chehab bp->used_count = 0; 4360c0d06caSMauro Carvalho Chehab bp->status = 0; 4370c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 4380c0d06caSMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferComplete %p stat=%d cnt=%d", 4390c0d06caSMauro Carvalho Chehab bp,urb->status,urb->actual_length); 4400c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 4410c0d06caSMauro Carvalho Chehab if ((!(urb->status)) || 4420c0d06caSMauro Carvalho Chehab (urb->status == -ENOENT) || 4430c0d06caSMauro Carvalho Chehab (urb->status == -ECONNRESET) || 4440c0d06caSMauro Carvalho Chehab (urb->status == -ESHUTDOWN)) { 4450c0d06caSMauro Carvalho Chehab (sp->buffers_processed)++; 4460c0d06caSMauro Carvalho Chehab sp->bytes_processed += urb->actual_length; 4470c0d06caSMauro Carvalho Chehab bp->used_count = urb->actual_length; 4480c0d06caSMauro Carvalho Chehab if (sp->fail_count) { 4490c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_TOLERANCE, 450*96292c89SMauro Carvalho Chehab "stream %p transfer ok - fail count reset", 451*96292c89SMauro Carvalho Chehab sp); 4520c0d06caSMauro Carvalho Chehab sp->fail_count = 0; 4530c0d06caSMauro Carvalho Chehab } 4540c0d06caSMauro Carvalho Chehab } else if (sp->fail_count < sp->fail_tolerance) { 4550c0d06caSMauro Carvalho Chehab // We can tolerate this error, because we're below the 4560c0d06caSMauro Carvalho Chehab // threshold... 4570c0d06caSMauro Carvalho Chehab (sp->fail_count)++; 4580c0d06caSMauro Carvalho Chehab (sp->buffers_failed)++; 4590c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_TOLERANCE, 460*96292c89SMauro Carvalho Chehab "stream %p ignoring error %d - fail count increased to %u", 4610c0d06caSMauro Carvalho Chehab sp,urb->status,sp->fail_count); 4620c0d06caSMauro Carvalho Chehab } else { 4630c0d06caSMauro Carvalho Chehab (sp->buffers_failed)++; 4640c0d06caSMauro Carvalho Chehab bp->status = urb->status; 4650c0d06caSMauro Carvalho Chehab } 4660c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 4670c0d06caSMauro Carvalho Chehab pvr2_buffer_set_ready(bp); 46819409c89SMauro Carvalho Chehab if (sp->callback_func) { 4690c0d06caSMauro Carvalho Chehab sp->callback_func(sp->callback_data); 4700c0d06caSMauro Carvalho Chehab } 4710c0d06caSMauro Carvalho Chehab } 4720c0d06caSMauro Carvalho Chehab 4730c0d06caSMauro Carvalho Chehab struct pvr2_stream *pvr2_stream_create(void) 4740c0d06caSMauro Carvalho Chehab { 4750c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 4760c0d06caSMauro Carvalho Chehab sp = kzalloc(sizeof(*sp),GFP_KERNEL); 4770c0d06caSMauro Carvalho Chehab if (!sp) return sp; 4780c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_INIT,"pvr2_stream_create: sp=%p",sp); 4790c0d06caSMauro Carvalho Chehab pvr2_stream_init(sp); 4800c0d06caSMauro Carvalho Chehab return sp; 4810c0d06caSMauro Carvalho Chehab } 4820c0d06caSMauro Carvalho Chehab 4830c0d06caSMauro Carvalho Chehab void pvr2_stream_destroy(struct pvr2_stream *sp) 4840c0d06caSMauro Carvalho Chehab { 4850c0d06caSMauro Carvalho Chehab if (!sp) return; 4860c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_INIT,"pvr2_stream_destroy: sp=%p",sp); 4870c0d06caSMauro Carvalho Chehab pvr2_stream_done(sp); 4880c0d06caSMauro Carvalho Chehab kfree(sp); 4890c0d06caSMauro Carvalho Chehab } 4900c0d06caSMauro Carvalho Chehab 4910c0d06caSMauro Carvalho Chehab void pvr2_stream_setup(struct pvr2_stream *sp, 4920c0d06caSMauro Carvalho Chehab struct usb_device *dev, 4930c0d06caSMauro Carvalho Chehab int endpoint, 4940c0d06caSMauro Carvalho Chehab unsigned int tolerance) 4950c0d06caSMauro Carvalho Chehab { 4960c0d06caSMauro Carvalho Chehab mutex_lock(&sp->mutex); do { 4970c0d06caSMauro Carvalho Chehab pvr2_stream_internal_flush(sp); 4980c0d06caSMauro Carvalho Chehab sp->dev = dev; 4990c0d06caSMauro Carvalho Chehab sp->endpoint = endpoint; 5000c0d06caSMauro Carvalho Chehab sp->fail_tolerance = tolerance; 5010c0d06caSMauro Carvalho Chehab } while(0); mutex_unlock(&sp->mutex); 5020c0d06caSMauro Carvalho Chehab } 5030c0d06caSMauro Carvalho Chehab 5040c0d06caSMauro Carvalho Chehab void pvr2_stream_set_callback(struct pvr2_stream *sp, 5050c0d06caSMauro Carvalho Chehab pvr2_stream_callback func, 5060c0d06caSMauro Carvalho Chehab void *data) 5070c0d06caSMauro Carvalho Chehab { 5080c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 509f419edd4SMauro Carvalho Chehab mutex_lock(&sp->mutex); 510f419edd4SMauro Carvalho Chehab do { 5110c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 5120c0d06caSMauro Carvalho Chehab sp->callback_data = data; 5130c0d06caSMauro Carvalho Chehab sp->callback_func = func; 5140c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 515f419edd4SMauro Carvalho Chehab } while(0); 516f419edd4SMauro Carvalho Chehab mutex_unlock(&sp->mutex); 5170c0d06caSMauro Carvalho Chehab } 5180c0d06caSMauro Carvalho Chehab 5190c0d06caSMauro Carvalho Chehab void pvr2_stream_get_stats(struct pvr2_stream *sp, 5200c0d06caSMauro Carvalho Chehab struct pvr2_stream_stats *stats, 5210c0d06caSMauro Carvalho Chehab int zero_counts) 5220c0d06caSMauro Carvalho Chehab { 5230c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 5240c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 5250c0d06caSMauro Carvalho Chehab if (stats) { 5260c0d06caSMauro Carvalho Chehab stats->buffers_in_queue = sp->q_count; 5270c0d06caSMauro Carvalho Chehab stats->buffers_in_idle = sp->i_count; 5280c0d06caSMauro Carvalho Chehab stats->buffers_in_ready = sp->r_count; 5290c0d06caSMauro Carvalho Chehab stats->buffers_processed = sp->buffers_processed; 5300c0d06caSMauro Carvalho Chehab stats->buffers_failed = sp->buffers_failed; 5310c0d06caSMauro Carvalho Chehab stats->bytes_processed = sp->bytes_processed; 5320c0d06caSMauro Carvalho Chehab } 5330c0d06caSMauro Carvalho Chehab if (zero_counts) { 5340c0d06caSMauro Carvalho Chehab sp->buffers_processed = 0; 5350c0d06caSMauro Carvalho Chehab sp->buffers_failed = 0; 5360c0d06caSMauro Carvalho Chehab sp->bytes_processed = 0; 5370c0d06caSMauro Carvalho Chehab } 5380c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 5390c0d06caSMauro Carvalho Chehab } 5400c0d06caSMauro Carvalho Chehab 5410c0d06caSMauro Carvalho Chehab /* Query / set the nominal buffer count */ 5420c0d06caSMauro Carvalho Chehab int pvr2_stream_get_buffer_count(struct pvr2_stream *sp) 5430c0d06caSMauro Carvalho Chehab { 5440c0d06caSMauro Carvalho Chehab return sp->buffer_target_count; 5450c0d06caSMauro Carvalho Chehab } 5460c0d06caSMauro Carvalho Chehab 5470c0d06caSMauro Carvalho Chehab int pvr2_stream_set_buffer_count(struct pvr2_stream *sp,unsigned int cnt) 5480c0d06caSMauro Carvalho Chehab { 5490c0d06caSMauro Carvalho Chehab int ret; 5500c0d06caSMauro Carvalho Chehab if (sp->buffer_target_count == cnt) return 0; 551f419edd4SMauro Carvalho Chehab mutex_lock(&sp->mutex); 552f419edd4SMauro Carvalho Chehab do { 5530c0d06caSMauro Carvalho Chehab sp->buffer_target_count = cnt; 5540c0d06caSMauro Carvalho Chehab ret = pvr2_stream_achieve_buffer_count(sp); 555f419edd4SMauro Carvalho Chehab } while(0); 556f419edd4SMauro Carvalho Chehab mutex_unlock(&sp->mutex); 5570c0d06caSMauro Carvalho Chehab return ret; 5580c0d06caSMauro Carvalho Chehab } 5590c0d06caSMauro Carvalho Chehab 5600c0d06caSMauro Carvalho Chehab struct pvr2_buffer *pvr2_stream_get_idle_buffer(struct pvr2_stream *sp) 5610c0d06caSMauro Carvalho Chehab { 5620c0d06caSMauro Carvalho Chehab struct list_head *lp = sp->idle_list.next; 5630c0d06caSMauro Carvalho Chehab if (lp == &sp->idle_list) return NULL; 5640c0d06caSMauro Carvalho Chehab return list_entry(lp,struct pvr2_buffer,list_overhead); 5650c0d06caSMauro Carvalho Chehab } 5660c0d06caSMauro Carvalho Chehab 5670c0d06caSMauro Carvalho Chehab struct pvr2_buffer *pvr2_stream_get_ready_buffer(struct pvr2_stream *sp) 5680c0d06caSMauro Carvalho Chehab { 5690c0d06caSMauro Carvalho Chehab struct list_head *lp = sp->ready_list.next; 5700c0d06caSMauro Carvalho Chehab if (lp == &sp->ready_list) return NULL; 5710c0d06caSMauro Carvalho Chehab return list_entry(lp,struct pvr2_buffer,list_overhead); 5720c0d06caSMauro Carvalho Chehab } 5730c0d06caSMauro Carvalho Chehab 5740c0d06caSMauro Carvalho Chehab struct pvr2_buffer *pvr2_stream_get_buffer(struct pvr2_stream *sp,int id) 5750c0d06caSMauro Carvalho Chehab { 5760c0d06caSMauro Carvalho Chehab if (id < 0) return NULL; 5770c0d06caSMauro Carvalho Chehab if (id >= sp->buffer_total_count) return NULL; 5780c0d06caSMauro Carvalho Chehab return sp->buffers[id]; 5790c0d06caSMauro Carvalho Chehab } 5800c0d06caSMauro Carvalho Chehab 5810c0d06caSMauro Carvalho Chehab int pvr2_stream_get_ready_count(struct pvr2_stream *sp) 5820c0d06caSMauro Carvalho Chehab { 5830c0d06caSMauro Carvalho Chehab return sp->r_count; 5840c0d06caSMauro Carvalho Chehab } 5850c0d06caSMauro Carvalho Chehab 5860c0d06caSMauro Carvalho Chehab void pvr2_stream_kill(struct pvr2_stream *sp) 5870c0d06caSMauro Carvalho Chehab { 5880c0d06caSMauro Carvalho Chehab struct pvr2_buffer *bp; 589f419edd4SMauro Carvalho Chehab mutex_lock(&sp->mutex); 590f419edd4SMauro Carvalho Chehab do { 5910c0d06caSMauro Carvalho Chehab pvr2_stream_internal_flush(sp); 5920c0d06caSMauro Carvalho Chehab while ((bp = pvr2_stream_get_ready_buffer(sp)) != NULL) { 5930c0d06caSMauro Carvalho Chehab pvr2_buffer_set_idle(bp); 5940c0d06caSMauro Carvalho Chehab } 5950c0d06caSMauro Carvalho Chehab if (sp->buffer_total_count != sp->buffer_target_count) { 5960c0d06caSMauro Carvalho Chehab pvr2_stream_achieve_buffer_count(sp); 5970c0d06caSMauro Carvalho Chehab } 598f419edd4SMauro Carvalho Chehab } while(0); 599f419edd4SMauro Carvalho Chehab mutex_unlock(&sp->mutex); 6000c0d06caSMauro Carvalho Chehab } 6010c0d06caSMauro Carvalho Chehab 6020c0d06caSMauro Carvalho Chehab int pvr2_buffer_queue(struct pvr2_buffer *bp) 6030c0d06caSMauro Carvalho Chehab { 6040c0d06caSMauro Carvalho Chehab #undef SEED_BUFFER 6050c0d06caSMauro Carvalho Chehab #ifdef SEED_BUFFER 6060c0d06caSMauro Carvalho Chehab unsigned int idx; 6070c0d06caSMauro Carvalho Chehab unsigned int val; 6080c0d06caSMauro Carvalho Chehab #endif 6090c0d06caSMauro Carvalho Chehab int ret = 0; 6100c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 6110c0d06caSMauro Carvalho Chehab if (!bp) return -EINVAL; 6120c0d06caSMauro Carvalho Chehab sp = bp->stream; 613f419edd4SMauro Carvalho Chehab mutex_lock(&sp->mutex); 614f419edd4SMauro Carvalho Chehab do { 6150c0d06caSMauro Carvalho Chehab pvr2_buffer_wipe(bp); 6160c0d06caSMauro Carvalho Chehab if (!sp->dev) { 6170c0d06caSMauro Carvalho Chehab ret = -EIO; 6180c0d06caSMauro Carvalho Chehab break; 6190c0d06caSMauro Carvalho Chehab } 6200c0d06caSMauro Carvalho Chehab pvr2_buffer_set_queued(bp); 6210c0d06caSMauro Carvalho Chehab #ifdef SEED_BUFFER 6220c0d06caSMauro Carvalho Chehab for (idx = 0; idx < (bp->max_count) / 4; idx++) { 6230c0d06caSMauro Carvalho Chehab val = bp->id << 24; 6240c0d06caSMauro Carvalho Chehab val |= idx; 6250c0d06caSMauro Carvalho Chehab ((unsigned int *)(bp->ptr))[idx] = val; 6260c0d06caSMauro Carvalho Chehab } 6270c0d06caSMauro Carvalho Chehab #endif 6280c0d06caSMauro Carvalho Chehab bp->status = -EINPROGRESS; 6290c0d06caSMauro Carvalho Chehab usb_fill_bulk_urb(bp->purb, // struct urb *urb 6300c0d06caSMauro Carvalho Chehab sp->dev, // struct usb_device *dev 6310c0d06caSMauro Carvalho Chehab // endpoint (below) 6320c0d06caSMauro Carvalho Chehab usb_rcvbulkpipe(sp->dev,sp->endpoint), 6330c0d06caSMauro Carvalho Chehab bp->ptr, // void *transfer_buffer 6340c0d06caSMauro Carvalho Chehab bp->max_count, // int buffer_length 6350c0d06caSMauro Carvalho Chehab buffer_complete, 6360c0d06caSMauro Carvalho Chehab bp); 6370c0d06caSMauro Carvalho Chehab usb_submit_urb(bp->purb,GFP_KERNEL); 638f419edd4SMauro Carvalho Chehab } while(0); 639f419edd4SMauro Carvalho Chehab mutex_unlock(&sp->mutex); 6400c0d06caSMauro Carvalho Chehab return ret; 6410c0d06caSMauro Carvalho Chehab } 6420c0d06caSMauro Carvalho Chehab 6430c0d06caSMauro Carvalho Chehab int pvr2_buffer_set_buffer(struct pvr2_buffer *bp,void *ptr,unsigned int cnt) 6440c0d06caSMauro Carvalho Chehab { 6450c0d06caSMauro Carvalho Chehab int ret = 0; 6460c0d06caSMauro Carvalho Chehab unsigned long irq_flags; 6470c0d06caSMauro Carvalho Chehab struct pvr2_stream *sp; 6480c0d06caSMauro Carvalho Chehab if (!bp) return -EINVAL; 6490c0d06caSMauro Carvalho Chehab sp = bp->stream; 650f419edd4SMauro Carvalho Chehab mutex_lock(&sp->mutex); 651f419edd4SMauro Carvalho Chehab do { 6520c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&sp->list_lock,irq_flags); 6530c0d06caSMauro Carvalho Chehab if (bp->state != pvr2_buffer_state_idle) { 6540c0d06caSMauro Carvalho Chehab ret = -EPERM; 6550c0d06caSMauro Carvalho Chehab } else { 6560c0d06caSMauro Carvalho Chehab bp->ptr = ptr; 6570c0d06caSMauro Carvalho Chehab bp->stream->i_bcount -= bp->max_count; 6580c0d06caSMauro Carvalho Chehab bp->max_count = cnt; 6590c0d06caSMauro Carvalho Chehab bp->stream->i_bcount += bp->max_count; 6600c0d06caSMauro Carvalho Chehab pvr2_trace(PVR2_TRACE_BUF_FLOW, 661*96292c89SMauro Carvalho Chehab "/*---TRACE_FLOW---*/ bufferPool %8s cap cap=%07d cnt=%02d", 6620c0d06caSMauro Carvalho Chehab pvr2_buffer_state_decode( 6630c0d06caSMauro Carvalho Chehab pvr2_buffer_state_idle), 6640c0d06caSMauro Carvalho Chehab bp->stream->i_bcount,bp->stream->i_count); 6650c0d06caSMauro Carvalho Chehab } 6660c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&sp->list_lock,irq_flags); 667f419edd4SMauro Carvalho Chehab } while(0); 668f419edd4SMauro Carvalho Chehab mutex_unlock(&sp->mutex); 6690c0d06caSMauro Carvalho Chehab return ret; 6700c0d06caSMauro Carvalho Chehab } 6710c0d06caSMauro Carvalho Chehab 6720c0d06caSMauro Carvalho Chehab unsigned int pvr2_buffer_get_count(struct pvr2_buffer *bp) 6730c0d06caSMauro Carvalho Chehab { 6740c0d06caSMauro Carvalho Chehab return bp->used_count; 6750c0d06caSMauro Carvalho Chehab } 6760c0d06caSMauro Carvalho Chehab 6770c0d06caSMauro Carvalho Chehab int pvr2_buffer_get_status(struct pvr2_buffer *bp) 6780c0d06caSMauro Carvalho Chehab { 6790c0d06caSMauro Carvalho Chehab return bp->status; 6800c0d06caSMauro Carvalho Chehab } 6810c0d06caSMauro Carvalho Chehab 6820c0d06caSMauro Carvalho Chehab int pvr2_buffer_get_id(struct pvr2_buffer *bp) 6830c0d06caSMauro Carvalho Chehab { 6840c0d06caSMauro Carvalho Chehab return bp->id; 6850c0d06caSMauro Carvalho Chehab } 686