Commit | Line | Data |
---|---|---|
d855497e MI |
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 | ||
c4028958 | 48 | static void pvr2_context_poll(struct work_struct *work) |
d855497e | 49 | { |
c4028958 DH |
50 | struct pvr2_context *mp = |
51 | container_of(work, struct pvr2_context, workpoll); | |
d855497e MI |
52 | pvr2_context_enter(mp); do { |
53 | pvr2_hdw_poll(mp->hdw); | |
54 | } while (0); pvr2_context_exit(mp); | |
55 | } | |
56 | ||
57 | ||
c4028958 | 58 | static void pvr2_context_setup(struct work_struct *work) |
d855497e | 59 | { |
c4028958 DH |
60 | struct pvr2_context *mp = |
61 | container_of(work, struct pvr2_context, workinit); | |
62 | ||
d855497e MI |
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 | { | |
a0fd1cb1 | 85 | struct pvr2_context *mp = NULL; |
d855497e MI |
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); | |
a0fd1cb1 | 95 | mp = NULL; |
d855497e MI |
96 | goto done; |
97 | } | |
98 | ||
99 | mp->workqueue = create_singlethread_workqueue("pvrusb2"); | |
c4028958 DH |
100 | INIT_WORK(&mp->workinit, pvr2_context_setup); |
101 | INIT_WORK(&mp->workpoll, pvr2_context_poll); | |
d855497e MI |
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; | |
a0fd1cb1 | 153 | cp->mc_next = NULL; |
d855497e MI |
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); | |
a0fd1cb1 MI |
168 | cp->stream->user = NULL; |
169 | cp->stream = NULL; | |
d855497e MI |
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 | } | |
a0fd1cb1 | 187 | cp->hdw = NULL; |
d855497e MI |
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(); | |
a0fd1cb1 | 220 | if (!cp) return NULL; |
d855497e MI |
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 | */ |