]>
Commit | Line | Data |
---|---|---|
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 | if (mp->workqueue) { | |
37 | flush_workqueue(mp->workqueue); | |
38 | destroy_workqueue(mp->workqueue); | |
39 | } | |
40 | kfree(mp); | |
41 | } | |
42 | ||
43 | ||
44 | static void pvr2_context_trigger_poll(struct pvr2_context *mp) | |
45 | { | |
46 | queue_work(mp->workqueue,&mp->workpoll); | |
47 | } | |
48 | ||
49 | ||
50 | static void pvr2_context_poll(struct work_struct *work) | |
51 | { | |
52 | struct pvr2_context *mp = | |
53 | container_of(work, struct pvr2_context, workpoll); | |
54 | pvr2_context_enter(mp); do { | |
55 | pvr2_hdw_poll(mp->hdw); | |
56 | } while (0); pvr2_context_exit(mp); | |
57 | } | |
58 | ||
59 | ||
60 | static void pvr2_context_setup(struct work_struct *work) | |
61 | { | |
62 | struct pvr2_context *mp = | |
63 | container_of(work, struct pvr2_context, workinit); | |
64 | ||
65 | pvr2_context_enter(mp); do { | |
66 | if (!pvr2_hdw_dev_ok(mp->hdw)) break; | |
67 | pvr2_hdw_setup(mp->hdw); | |
68 | pvr2_hdw_setup_poll_trigger( | |
69 | mp->hdw, | |
70 | (void (*)(void *))pvr2_context_trigger_poll, | |
71 | mp); | |
72 | if (!pvr2_hdw_dev_ok(mp->hdw)) break; | |
73 | if (!pvr2_hdw_init_ok(mp->hdw)) break; | |
74 | mp->video_stream.stream = pvr2_hdw_get_video_stream(mp->hdw); | |
75 | if (mp->setup_func) { | |
76 | mp->setup_func(mp); | |
77 | } | |
78 | } while (0); pvr2_context_exit(mp); | |
79 | } | |
80 | ||
81 | ||
82 | struct pvr2_context *pvr2_context_create( | |
83 | struct usb_interface *intf, | |
84 | const struct usb_device_id *devid, | |
85 | void (*setup_func)(struct pvr2_context *)) | |
86 | { | |
87 | struct pvr2_context *mp = NULL; | |
88 | mp = kzalloc(sizeof(*mp),GFP_KERNEL); | |
89 | if (!mp) goto done; | |
90 | pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr_main id=%p",mp); | |
91 | mp->setup_func = setup_func; | |
92 | mutex_init(&mp->mutex); | |
93 | mp->hdw = pvr2_hdw_create(intf,devid); | |
94 | if (!mp->hdw) { | |
95 | pvr2_context_destroy(mp); | |
96 | mp = NULL; | |
97 | goto done; | |
98 | } | |
99 | ||
100 | mp->workqueue = create_singlethread_workqueue("pvrusb2"); | |
101 | INIT_WORK(&mp->workinit, pvr2_context_setup); | |
102 | INIT_WORK(&mp->workpoll, pvr2_context_poll); | |
103 | queue_work(mp->workqueue,&mp->workinit); | |
104 | done: | |
105 | return mp; | |
106 | } | |
107 | ||
108 | ||
109 | void pvr2_context_enter(struct pvr2_context *mp) | |
110 | { | |
111 | mutex_lock(&mp->mutex); | |
112 | pvr2_trace(PVR2_TRACE_CREG,"pvr2_context_enter(id=%p)",mp); | |
113 | } | |
114 | ||
115 | ||
116 | void pvr2_context_exit(struct pvr2_context *mp) | |
117 | { | |
118 | int destroy_flag = 0; | |
119 | if (!(mp->mc_first || !mp->disconnect_flag)) { | |
120 | destroy_flag = !0; | |
121 | } | |
122 | pvr2_trace(PVR2_TRACE_CREG,"pvr2_context_exit(id=%p) outside",mp); | |
123 | mutex_unlock(&mp->mutex); | |
124 | if (destroy_flag) pvr2_context_destroy(mp); | |
125 | } | |
126 | ||
127 | ||
128 | static void pvr2_context_run_checks(struct pvr2_context *mp) | |
129 | { | |
130 | struct pvr2_channel *ch1,*ch2; | |
131 | for (ch1 = mp->mc_first; ch1; ch1 = ch2) { | |
132 | ch2 = ch1->mc_next; | |
133 | if (ch1->check_func) { | |
134 | ch1->check_func(ch1); | |
135 | } | |
136 | } | |
137 | } | |
138 | ||
139 | ||
140 | void pvr2_context_disconnect(struct pvr2_context *mp) | |
141 | { | |
142 | pvr2_context_enter(mp); do { | |
143 | pvr2_hdw_disconnect(mp->hdw); | |
144 | mp->disconnect_flag = !0; | |
145 | pvr2_context_run_checks(mp); | |
146 | } while (0); pvr2_context_exit(mp); | |
147 | } | |
148 | ||
149 | ||
150 | void pvr2_channel_init(struct pvr2_channel *cp,struct pvr2_context *mp) | |
151 | { | |
152 | cp->hdw = mp->hdw; | |
153 | cp->mc_head = mp; | |
154 | cp->mc_next = NULL; | |
155 | cp->mc_prev = mp->mc_last; | |
156 | if (mp->mc_last) { | |
157 | mp->mc_last->mc_next = cp; | |
158 | } else { | |
159 | mp->mc_first = cp; | |
160 | } | |
161 | mp->mc_last = cp; | |
162 | } | |
163 | ||
164 | ||
165 | static void pvr2_channel_disclaim_stream(struct pvr2_channel *cp) | |
166 | { | |
167 | if (!cp->stream) return; | |
168 | pvr2_stream_kill(cp->stream->stream); | |
169 | cp->stream->user = NULL; | |
170 | cp->stream = NULL; | |
171 | } | |
172 | ||
173 | ||
174 | void pvr2_channel_done(struct pvr2_channel *cp) | |
175 | { | |
176 | struct pvr2_context *mp = cp->mc_head; | |
177 | pvr2_channel_disclaim_stream(cp); | |
178 | if (cp->mc_next) { | |
179 | cp->mc_next->mc_prev = cp->mc_prev; | |
180 | } else { | |
181 | mp->mc_last = cp->mc_prev; | |
182 | } | |
183 | if (cp->mc_prev) { | |
184 | cp->mc_prev->mc_next = cp->mc_next; | |
185 | } else { | |
186 | mp->mc_first = cp->mc_next; | |
187 | } | |
188 | cp->hdw = NULL; | |
189 | } | |
190 | ||
191 | ||
192 | int pvr2_channel_claim_stream(struct pvr2_channel *cp, | |
193 | struct pvr2_context_stream *sp) | |
194 | { | |
195 | int code = 0; | |
196 | pvr2_context_enter(cp->mc_head); do { | |
197 | if (sp == cp->stream) break; | |
198 | if (sp->user) { | |
199 | code = -EBUSY; | |
200 | break; | |
201 | } | |
202 | pvr2_channel_disclaim_stream(cp); | |
203 | if (!sp) break; | |
204 | sp->user = cp; | |
205 | cp->stream = sp; | |
206 | } while (0); pvr2_context_exit(cp->mc_head); | |
207 | return code; | |
208 | } | |
209 | ||
210 | ||
211 | // This is the marker for the real beginning of a legitimate mpeg2 stream. | |
212 | static char stream_sync_key[] = { | |
213 | 0x00, 0x00, 0x01, 0xba, | |
214 | }; | |
215 | ||
216 | struct pvr2_ioread *pvr2_channel_create_mpeg_stream( | |
217 | struct pvr2_context_stream *sp) | |
218 | { | |
219 | struct pvr2_ioread *cp; | |
220 | cp = pvr2_ioread_create(); | |
221 | if (!cp) return NULL; | |
222 | pvr2_ioread_setup(cp,sp->stream); | |
223 | pvr2_ioread_set_sync_key(cp,stream_sync_key,sizeof(stream_sync_key)); | |
224 | return cp; | |
225 | } | |
226 | ||
227 | ||
228 | /* | |
229 | Stuff for Emacs to see, in order to encourage consistent editing style: | |
230 | *** Local Variables: *** | |
231 | *** mode: c *** | |
232 | *** fill-column: 75 *** | |
233 | *** tab-width: 8 *** | |
234 | *** c-basic-offset: 8 *** | |
235 | *** End: *** | |
236 | */ |