drivers/media/video/pvrusb2/pvrusb2-context.c

   1 /*
   2  *  $Id$
   3  *
   4  *  Copyright (C) 2005 Mike Isely <isely@pobox.com>
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2 of the License
   9  *
  10  *  This program is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with this program; if not, write to the Free Software
  17  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  18  *
  19  */
  20
  21 #include "pvrusb2-context.h"
  22 #include "pvrusb2-io.h"
  23 #include "pvrusb2-ioread.h"
  24 #include "pvrusb2-hdw.h"
  25 #include "pvrusb2-debug.h"
  26 #include <linux/errno.h>
  27 #include <linux/string.h>
  28 #include <linux/slab.h>
  29 #include <asm/semaphore.h>
  30
  31
  32 static void pvr2_context_destroy(struct pvr2_context *mp)
  33 {
  34         if (mp->hdw) pvr2_hdw_destroy(mp->hdw);
  35         pvr2_trace(PVR2_TRACE_STRUCT,"Destroying pvr_main id=%p",mp);
  36         flush_workqueue(mp->workqueue);
  37         destroy_workqueue(mp->workqueue);
  38         kfree(mp);
  39 }
  40
  41
  42 static void pvr2_context_trigger_poll(struct pvr2_context *mp)
  43 {
  44         queue_work(mp->workqueue,&mp->workpoll);
  45 }
  46
  47
  48 static void pvr2_context_poll(struct work_struct *work)
  49 {
  50         struct pvr2_context *mp =
  51                 container_of(work, struct pvr2_context, workpoll);
  52         pvr2_context_enter(mp); do {
  53                 pvr2_hdw_poll(mp->hdw);
  54         } while (0); pvr2_context_exit(mp);
  55 }
  56
  57
  58 static void pvr2_context_setup(struct work_struct *work)
  59 {
  60         struct pvr2_context *mp =
  61                 container_of(work, struct pvr2_context, workinit);
  62
  63         pvr2_context_enter(mp); do {
  64                 if (!pvr2_hdw_dev_ok(mp->hdw)) break;
  65                 pvr2_hdw_setup(mp->hdw);
  66                 pvr2_hdw_setup_poll_trigger(
  67                         mp->hdw,
  68                         (void (*)(void *))pvr2_context_trigger_poll,
  69                         mp);
  70                 if (!pvr2_hdw_dev_ok(mp->hdw)) break;
  71                 if (!pvr2_hdw_init_ok(mp->hdw)) break;
  72                 mp->video_stream.stream = pvr2_hdw_get_video_stream(mp->hdw);
  73                 if (mp->setup_func) {
  74                         mp->setup_func(mp);
  75                 }
  76         } while (0); pvr2_context_exit(mp);
  77 }
  78
  79
  80 struct pvr2_context *pvr2_context_create(
  81         struct usb_interface *intf,
  82         const struct usb_device_id *devid,
  83         void (*setup_func)(struct pvr2_context *))
  84 {
  85         struct pvr2_context *mp = NULL;
  86         mp = kmalloc(sizeof(*mp),GFP_KERNEL);
  87         if (!mp) goto done;
  88         memset(mp,0,sizeof(*mp));
  89         pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr_main id=%p",mp);
  90         mp->setup_func = setup_func;
  91         mutex_init(&mp->mutex);
  92         mp->hdw = pvr2_hdw_create(intf,devid);
  93         if (!mp->hdw) {
  94                 pvr2_context_destroy(mp);
  95                 mp = NULL;
  96                 goto done;
  97         }
  98
  99         mp->workqueue = create_singlethread_workqueue("pvrusb2");
 100         INIT_WORK(&mp->workinit, pvr2_context_setup);
 101         INIT_WORK(&mp->workpoll, pvr2_context_poll);
 102         queue_work(mp->workqueue,&mp->workinit);
 103  done:
 104         return mp;
 105 }
 106
 107
 108 void pvr2_context_enter(struct pvr2_context *mp)
 109 {
 110         mutex_lock(&mp->mutex);
 111         pvr2_trace(PVR2_TRACE_CREG,"pvr2_context_enter(id=%p)",mp);
 112 }
 113
 114
 115 void pvr2_context_exit(struct pvr2_context *mp)
 116 {
 117         int destroy_flag = 0;
 118         if (!(mp->mc_first || !mp->disconnect_flag)) {
 119                 destroy_flag = !0;
 120         }
 121         pvr2_trace(PVR2_TRACE_CREG,"pvr2_context_exit(id=%p) outside",mp);
 122         mutex_unlock(&mp->mutex);
 123         if (destroy_flag) pvr2_context_destroy(mp);
 124 }
 125
 126
 127 static void pvr2_context_run_checks(struct pvr2_context *mp)
 128 {
 129         struct pvr2_channel *ch1,*ch2;
 130         for (ch1 = mp->mc_first; ch1; ch1 = ch2) {
 131                 ch2 = ch1->mc_next;
 132                 if (ch1->check_func) {
 133                         ch1->check_func(ch1);
 134                 }
 135         }
 136 }
 137
 138
 139 void pvr2_context_disconnect(struct pvr2_context *mp)
 140 {
 141         pvr2_context_enter(mp); do {
 142                 pvr2_hdw_disconnect(mp->hdw);
 143                 mp->disconnect_flag = !0;
 144                 pvr2_context_run_checks(mp);
 145         } while (0); pvr2_context_exit(mp);
 146 }
 147
 148
 149 void pvr2_channel_init(struct pvr2_channel *cp,struct pvr2_context *mp)
 150 {
 151         cp->hdw = mp->hdw;
 152         cp->mc_head = mp;
 153         cp->mc_next = NULL;
 154         cp->mc_prev = mp->mc_last;
 155         if (mp->mc_last) {
 156                 mp->mc_last->mc_next = cp;
 157         } else {
 158                 mp->mc_first = cp;
 159         }
 160         mp->mc_last = cp;
 161 }
 162
 163
 164 static void pvr2_channel_disclaim_stream(struct pvr2_channel *cp)
 165 {
 166         if (!cp->stream) return;
 167         pvr2_stream_kill(cp->stream->stream);
 168         cp->stream->user = NULL;
 169         cp->stream = NULL;
 170 }
 171
 172
 173 void pvr2_channel_done(struct pvr2_channel *cp)
 174 {
 175         struct pvr2_context *mp = cp->mc_head;
 176         pvr2_channel_disclaim_stream(cp);
 177         if (cp->mc_next) {
 178                 cp->mc_next->mc_prev = cp->mc_prev;
 179         } else {
 180                 mp->mc_last = cp->mc_prev;
 181         }
 182         if (cp->mc_prev) {
 183                 cp->mc_prev->mc_next = cp->mc_next;
 184         } else {
 185                 mp->mc_first = cp->mc_next;
 186         }
 187         cp->hdw = NULL;
 188 }
 189
 190
 191 int pvr2_channel_claim_stream(struct pvr2_channel *cp,
 192                               struct pvr2_context_stream *sp)
 193 {
 194         int code = 0;
 195         pvr2_context_enter(cp->mc_head); do {
 196                 if (sp == cp->stream) break;
 197                 if (sp->user) {
 198                         code = -EBUSY;
 199                         break;
 200                 }
 201                 pvr2_channel_disclaim_stream(cp);
 202                 if (!sp) break;
 203                 sp->user = cp;
 204                 cp->stream = sp;
 205         } while (0); pvr2_context_exit(cp->mc_head);
 206         return code;
 207 }
 208
 209
 210 // This is the marker for the real beginning of a legitimate mpeg2 stream.
 211 static char stream_sync_key[] = {
 212         0x00, 0x00, 0x01, 0xba,
 213 };
 214
 215 struct pvr2_ioread *pvr2_channel_create_mpeg_stream(
 216         struct pvr2_context_stream *sp)
 217 {
 218         struct pvr2_ioread *cp;
 219         cp = pvr2_ioread_create();
 220         if (!cp) return NULL;
 221         pvr2_ioread_setup(cp,sp->stream);
 222         pvr2_ioread_set_sync_key(cp,stream_sync_key,sizeof(stream_sync_key));
 223         return cp;
 224 }
 225
 226
 227 /*
 228   Stuff for Emacs to see, in order to encourage consistent editing style:
 229   *** Local Variables: ***
 230   *** mode: c ***
 231   *** fill-column: 75 ***
 232   *** tab-width: 8 ***
 233   *** c-basic-offset: 8 ***
 234   *** End: ***
 235   */