]>
Commit | Line | Data |
---|---|---|
e5275793 US |
1 | /**************************************************************** |
2 | ||
3 | Siano Mobile Silicon, Inc. | |
4 | MDTV receiver kernel modules. | |
5 | Copyright (C) 2006-2008, Uri Shkolnik | |
6 | ||
7 | This program is free software: you can redistribute it and/or modify | |
8 | it under the terms of the GNU General Public License as published by | |
9 | the Free Software Foundation, either version 2 of the License, or | |
10 | (at your option) any later version. | |
11 | ||
12 | This program is distributed in the hope that it will be useful, | |
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | GNU General Public License for more details. | |
16 | ||
17 | You should have received a copy of the GNU General Public License | |
18 | along with this program. If not, see <http://www.gnu.org/licenses/>. | |
19 | ||
20 | ****************************************************************/ | |
8d4f9d0e | 21 | |
2e5c1ec8 | 22 | #include <linux/module.h> |
5a0e3ad6 | 23 | #include <linux/slab.h> |
2e5c1ec8 MK |
24 | #include <linux/init.h> |
25 | ||
c9679e3b US |
26 | #include "dmxdev.h" |
27 | #include "dvbdev.h" | |
28 | #include "dvb_demux.h" | |
29 | #include "dvb_frontend.h" | |
30 | ||
2e5c1ec8 | 31 | #include "smscoreapi.h" |
ba79bb2c | 32 | #include "smsendian.h" |
1c11d546 | 33 | #include "sms-cards.h" |
2e5c1ec8 | 34 | |
9c59f968 MK |
35 | DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); |
36 | ||
62c7167d MK |
37 | struct smsdvb_client_t { |
38 | struct list_head entry; | |
39 | ||
40 | struct smscore_device_t *coredev; | |
41 | struct smscore_client_t *smsclient; | |
42 | ||
43 | struct dvb_adapter adapter; | |
44 | struct dvb_demux demux; | |
45 | struct dmxdev dmxdev; | |
46 | struct dvb_frontend frontend; | |
47 | ||
48 | fe_status_t fe_status; | |
62c7167d | 49 | |
793786d1 | 50 | struct completion tune_done; |
62c7167d MK |
51 | |
52 | /* todo: save freq/band instead whole struct */ | |
53 | struct dvb_frontend_parameters fe_params; | |
793786d1 US |
54 | |
55 | struct SMSHOSTLIB_STATISTICS_DVB_S sms_stat_dvb; | |
56 | int event_fe_state; | |
57 | int event_unc_state; | |
62c7167d MK |
58 | }; |
59 | ||
c5e0bd1a AB |
60 | static struct list_head g_smsdvb_clients; |
61 | static struct mutex g_smsdvb_clientslock; | |
2e5c1ec8 | 62 | |
0d02efe4 MK |
63 | static int sms_dbg; |
64 | module_param_named(debug, sms_dbg, int, 0644); | |
65 | MODULE_PARM_DESC(debug, "set debug level (info=1, adv=2 (or-able))"); | |
66 | ||
793786d1 US |
67 | /* Events that may come from DVB v3 adapter */ |
68 | static void sms_board_dvb3_event(struct smsdvb_client_t *client, | |
69 | enum SMS_DVB3_EVENTS event) { | |
4db989f7 US |
70 | |
71 | struct smscore_device_t *coredev = client->coredev; | |
72 | switch (event) { | |
73 | case DVB3_EVENT_INIT: | |
74 | sms_debug("DVB3_EVENT_INIT"); | |
75 | sms_board_event(coredev, BOARD_EVENT_BIND); | |
76 | break; | |
77 | case DVB3_EVENT_SLEEP: | |
78 | sms_debug("DVB3_EVENT_SLEEP"); | |
79 | sms_board_event(coredev, BOARD_EVENT_POWER_SUSPEND); | |
80 | break; | |
81 | case DVB3_EVENT_HOTPLUG: | |
82 | sms_debug("DVB3_EVENT_HOTPLUG"); | |
83 | sms_board_event(coredev, BOARD_EVENT_POWER_INIT); | |
84 | break; | |
85 | case DVB3_EVENT_FE_LOCK: | |
86 | if (client->event_fe_state != DVB3_EVENT_FE_LOCK) { | |
87 | client->event_fe_state = DVB3_EVENT_FE_LOCK; | |
88 | sms_debug("DVB3_EVENT_FE_LOCK"); | |
89 | sms_board_event(coredev, BOARD_EVENT_FE_LOCK); | |
90 | } | |
91 | break; | |
92 | case DVB3_EVENT_FE_UNLOCK: | |
93 | if (client->event_fe_state != DVB3_EVENT_FE_UNLOCK) { | |
94 | client->event_fe_state = DVB3_EVENT_FE_UNLOCK; | |
95 | sms_debug("DVB3_EVENT_FE_UNLOCK"); | |
96 | sms_board_event(coredev, BOARD_EVENT_FE_UNLOCK); | |
97 | } | |
98 | break; | |
99 | case DVB3_EVENT_UNC_OK: | |
100 | if (client->event_unc_state != DVB3_EVENT_UNC_OK) { | |
101 | client->event_unc_state = DVB3_EVENT_UNC_OK; | |
102 | sms_debug("DVB3_EVENT_UNC_OK"); | |
103 | sms_board_event(coredev, BOARD_EVENT_MULTIPLEX_OK); | |
104 | } | |
105 | break; | |
106 | case DVB3_EVENT_UNC_ERR: | |
107 | if (client->event_unc_state != DVB3_EVENT_UNC_ERR) { | |
108 | client->event_unc_state = DVB3_EVENT_UNC_ERR; | |
109 | sms_debug("DVB3_EVENT_UNC_ERR"); | |
110 | sms_board_event(coredev, BOARD_EVENT_MULTIPLEX_ERRORS); | |
111 | } | |
112 | break; | |
113 | ||
114 | default: | |
115 | sms_err("Unknown dvb3 api event"); | |
116 | break; | |
117 | } | |
793786d1 US |
118 | } |
119 | ||
5eb23975 MCC |
120 | |
121 | static void smsdvb_update_dvb_stats(struct RECEPTION_STATISTICS_S *pReceptionData, | |
122 | struct SMSHOSTLIB_STATISTICS_ST *p) | |
123 | { | |
124 | if (sms_dbg & 2) { | |
125 | printk(KERN_DEBUG "Reserved = %d", p->Reserved); | |
126 | printk(KERN_DEBUG "IsRfLocked = %d", p->IsRfLocked); | |
127 | printk(KERN_DEBUG "IsDemodLocked = %d", p->IsDemodLocked); | |
128 | printk(KERN_DEBUG "IsExternalLNAOn = %d", p->IsExternalLNAOn); | |
129 | printk(KERN_DEBUG "SNR = %d", p->SNR); | |
130 | printk(KERN_DEBUG "BER = %d", p->BER); | |
131 | printk(KERN_DEBUG "FIB_CRC = %d", p->FIB_CRC); | |
132 | printk(KERN_DEBUG "TS_PER = %d", p->TS_PER); | |
133 | printk(KERN_DEBUG "MFER = %d", p->MFER); | |
134 | printk(KERN_DEBUG "RSSI = %d", p->RSSI); | |
135 | printk(KERN_DEBUG "InBandPwr = %d", p->InBandPwr); | |
136 | printk(KERN_DEBUG "CarrierOffset = %d", p->CarrierOffset); | |
137 | printk(KERN_DEBUG "Frequency = %d", p->Frequency); | |
138 | printk(KERN_DEBUG "Bandwidth = %d", p->Bandwidth); | |
139 | printk(KERN_DEBUG "TransmissionMode = %d", p->TransmissionMode); | |
140 | printk(KERN_DEBUG "ModemState = %d", p->ModemState); | |
141 | printk(KERN_DEBUG "GuardInterval = %d", p->GuardInterval); | |
142 | printk(KERN_DEBUG "CodeRate = %d", p->CodeRate); | |
143 | printk(KERN_DEBUG "LPCodeRate = %d", p->LPCodeRate); | |
144 | printk(KERN_DEBUG "Hierarchy = %d", p->Hierarchy); | |
145 | printk(KERN_DEBUG "Constellation = %d", p->Constellation); | |
146 | printk(KERN_DEBUG "BurstSize = %d", p->BurstSize); | |
147 | printk(KERN_DEBUG "BurstDuration = %d", p->BurstDuration); | |
148 | printk(KERN_DEBUG "BurstCycleTime = %d", p->BurstCycleTime); | |
149 | printk(KERN_DEBUG "CalculatedBurstCycleTime = %d", p->CalculatedBurstCycleTime); | |
150 | printk(KERN_DEBUG "NumOfRows = %d", p->NumOfRows); | |
151 | printk(KERN_DEBUG "NumOfPaddCols = %d", p->NumOfPaddCols); | |
152 | printk(KERN_DEBUG "NumOfPunctCols = %d", p->NumOfPunctCols); | |
153 | printk(KERN_DEBUG "ErrorTSPackets = %d", p->ErrorTSPackets); | |
154 | printk(KERN_DEBUG "TotalTSPackets = %d", p->TotalTSPackets); | |
155 | printk(KERN_DEBUG "NumOfValidMpeTlbs = %d", p->NumOfValidMpeTlbs); | |
156 | printk(KERN_DEBUG "NumOfInvalidMpeTlbs = %d", p->NumOfInvalidMpeTlbs); | |
157 | printk(KERN_DEBUG "NumOfCorrectedMpeTlbs = %d", p->NumOfCorrectedMpeTlbs); | |
158 | printk(KERN_DEBUG "BERErrorCount = %d", p->BERErrorCount); | |
159 | printk(KERN_DEBUG "BERBitCount = %d", p->BERBitCount); | |
160 | printk(KERN_DEBUG "SmsToHostTxErrors = %d", p->SmsToHostTxErrors); | |
161 | printk(KERN_DEBUG "PreBER = %d", p->PreBER); | |
162 | printk(KERN_DEBUG "CellId = %d", p->CellId); | |
163 | printk(KERN_DEBUG "DvbhSrvIndHP = %d", p->DvbhSrvIndHP); | |
164 | printk(KERN_DEBUG "DvbhSrvIndLP = %d", p->DvbhSrvIndLP); | |
165 | printk(KERN_DEBUG "NumMPEReceived = %d", p->NumMPEReceived); | |
5eb23975 MCC |
166 | } |
167 | ||
168 | pReceptionData->IsDemodLocked = p->IsDemodLocked; | |
169 | ||
170 | pReceptionData->SNR = p->SNR; | |
171 | pReceptionData->BER = p->BER; | |
172 | pReceptionData->BERErrorCount = p->BERErrorCount; | |
173 | pReceptionData->InBandPwr = p->InBandPwr; | |
174 | pReceptionData->ErrorTSPackets = p->ErrorTSPackets; | |
175 | }; | |
176 | ||
177 | ||
178 | static void smsdvb_update_isdbt_stats(struct RECEPTION_STATISTICS_S *pReceptionData, | |
179 | struct SMSHOSTLIB_STATISTICS_ISDBT_ST *p) | |
180 | { | |
181 | int i; | |
182 | ||
183 | if (sms_dbg & 2) { | |
184 | printk(KERN_DEBUG "IsRfLocked = %d", p->IsRfLocked); | |
185 | printk(KERN_DEBUG "IsDemodLocked = %d", p->IsDemodLocked); | |
186 | printk(KERN_DEBUG "IsExternalLNAOn = %d", p->IsExternalLNAOn); | |
187 | printk(KERN_DEBUG "SNR = %d", p->SNR); | |
188 | printk(KERN_DEBUG "RSSI = %d", p->RSSI); | |
189 | printk(KERN_DEBUG "InBandPwr = %d", p->InBandPwr); | |
190 | printk(KERN_DEBUG "CarrierOffset = %d", p->CarrierOffset); | |
191 | printk(KERN_DEBUG "Frequency = %d", p->Frequency); | |
192 | printk(KERN_DEBUG "Bandwidth = %d", p->Bandwidth); | |
193 | printk(KERN_DEBUG "TransmissionMode = %d", p->TransmissionMode); | |
194 | printk(KERN_DEBUG "ModemState = %d", p->ModemState); | |
195 | printk(KERN_DEBUG "GuardInterval = %d", p->GuardInterval); | |
196 | printk(KERN_DEBUG "SystemType = %d", p->SystemType); | |
197 | printk(KERN_DEBUG "PartialReception = %d", p->PartialReception); | |
198 | printk(KERN_DEBUG "NumOfLayers = %d", p->NumOfLayers); | |
199 | printk(KERN_DEBUG "SmsToHostTxErrors = %d", p->SmsToHostTxErrors); | |
200 | ||
201 | for (i = 0; i < 3; i++) { | |
202 | printk(KERN_DEBUG "%d: CodeRate = %d", i, p->LayerInfo[i].CodeRate); | |
203 | printk(KERN_DEBUG "%d: Constellation = %d", i, p->LayerInfo[i].Constellation); | |
204 | printk(KERN_DEBUG "%d: BER = %d", i, p->LayerInfo[i].BER); | |
205 | printk(KERN_DEBUG "%d: BERErrorCount = %d", i, p->LayerInfo[i].BERErrorCount); | |
206 | printk(KERN_DEBUG "%d: BERBitCount = %d", i, p->LayerInfo[i].BERBitCount); | |
207 | printk(KERN_DEBUG "%d: PreBER = %d", i, p->LayerInfo[i].PreBER); | |
208 | printk(KERN_DEBUG "%d: TS_PER = %d", i, p->LayerInfo[i].TS_PER); | |
209 | printk(KERN_DEBUG "%d: ErrorTSPackets = %d", i, p->LayerInfo[i].ErrorTSPackets); | |
210 | printk(KERN_DEBUG "%d: TotalTSPackets = %d", i, p->LayerInfo[i].TotalTSPackets); | |
211 | printk(KERN_DEBUG "%d: TILdepthI = %d", i, p->LayerInfo[i].TILdepthI); | |
212 | printk(KERN_DEBUG "%d: NumberOfSegments = %d", i, p->LayerInfo[i].NumberOfSegments); | |
213 | printk(KERN_DEBUG "%d: TMCCErrors = %d", i, p->LayerInfo[i].TMCCErrors); | |
214 | } | |
215 | } | |
216 | ||
217 | pReceptionData->IsDemodLocked = p->IsDemodLocked; | |
218 | ||
219 | pReceptionData->SNR = p->SNR; | |
220 | pReceptionData->InBandPwr = p->InBandPwr; | |
221 | ||
222 | pReceptionData->ErrorTSPackets = 0; | |
223 | pReceptionData->BER = 0; | |
224 | pReceptionData->BERErrorCount = 0; | |
225 | for (i = 0; i < 3; i++) { | |
226 | pReceptionData->BER += p->LayerInfo[i].BER; | |
227 | pReceptionData->BERErrorCount += p->LayerInfo[i].BERErrorCount; | |
228 | pReceptionData->ErrorTSPackets += p->LayerInfo[i].ErrorTSPackets; | |
229 | } | |
230 | } | |
231 | ||
0c071f37 | 232 | static int smsdvb_onresponse(void *context, struct smscore_buffer_t *cb) |
2e5c1ec8 | 233 | { |
18245e18 | 234 | struct smsdvb_client_t *client = (struct smsdvb_client_t *) context; |
793786d1 US |
235 | struct SmsMsgHdr_ST *phdr = (struct SmsMsgHdr_ST *) (((u8 *) cb->p) |
236 | + cb->offset); | |
237 | u32 *pMsgData = (u32 *) phdr + 1; | |
238 | /*u32 MsgDataLen = phdr->msgLength - sizeof(struct SmsMsgHdr_ST);*/ | |
239 | bool is_status_update = false; | |
2e5c1ec8 | 240 | |
ba79bb2c US |
241 | smsendian_handle_rx_message((struct SmsMsgData_ST *) phdr); |
242 | ||
fa830e8a | 243 | switch (phdr->msgType) { |
82237416 MK |
244 | case MSG_SMS_DVBT_BDA_DATA: |
245 | dvb_dmx_swfilter(&client->demux, (u8 *)(phdr + 1), | |
18245e18 | 246 | cb->size - sizeof(struct SmsMsgHdr_ST)); |
82237416 MK |
247 | break; |
248 | ||
249 | case MSG_SMS_RF_TUNE_RES: | |
6b26fcea | 250 | case MSG_SMS_ISDBT_TUNE_RES: |
82237416 MK |
251 | complete(&client->tune_done); |
252 | break; | |
2e5c1ec8 | 253 | |
793786d1 US |
254 | case MSG_SMS_SIGNAL_DETECTED_IND: |
255 | sms_info("MSG_SMS_SIGNAL_DETECTED_IND"); | |
256 | client->sms_stat_dvb.TransmissionData.IsDemodLocked = true; | |
257 | is_status_update = true; | |
258 | break; | |
259 | ||
260 | case MSG_SMS_NO_SIGNAL_IND: | |
261 | sms_info("MSG_SMS_NO_SIGNAL_IND"); | |
262 | client->sms_stat_dvb.TransmissionData.IsDemodLocked = false; | |
263 | is_status_update = true; | |
264 | break; | |
265 | ||
266 | case MSG_SMS_TRANSMISSION_IND: { | |
267 | sms_info("MSG_SMS_TRANSMISSION_IND"); | |
268 | ||
269 | pMsgData++; | |
270 | memcpy(&client->sms_stat_dvb.TransmissionData, pMsgData, | |
271 | sizeof(struct TRANSMISSION_STATISTICS_S)); | |
272 | ||
273 | /* Mo need to correct guard interval | |
274 | * (as opposed to old statistics message). | |
275 | */ | |
276 | CORRECT_STAT_BANDWIDTH(client->sms_stat_dvb.TransmissionData); | |
277 | CORRECT_STAT_TRANSMISSON_MODE( | |
278 | client->sms_stat_dvb.TransmissionData); | |
279 | is_status_update = true; | |
280 | break; | |
281 | } | |
282 | case MSG_SMS_HO_PER_SLICES_IND: { | |
283 | struct RECEPTION_STATISTICS_S *pReceptionData = | |
284 | &client->sms_stat_dvb.ReceptionData; | |
285 | struct SRVM_SIGNAL_STATUS_S SignalStatusData; | |
286 | ||
287 | /*sms_info("MSG_SMS_HO_PER_SLICES_IND");*/ | |
288 | pMsgData++; | |
289 | SignalStatusData.result = pMsgData[0]; | |
290 | SignalStatusData.snr = pMsgData[1]; | |
291 | SignalStatusData.inBandPower = (s32) pMsgData[2]; | |
292 | SignalStatusData.tsPackets = pMsgData[3]; | |
293 | SignalStatusData.etsPackets = pMsgData[4]; | |
294 | SignalStatusData.constellation = pMsgData[5]; | |
295 | SignalStatusData.hpCode = pMsgData[6]; | |
296 | SignalStatusData.tpsSrvIndLP = pMsgData[7] & 0x03; | |
297 | SignalStatusData.tpsSrvIndHP = pMsgData[8] & 0x03; | |
298 | SignalStatusData.cellId = pMsgData[9] & 0xFFFF; | |
299 | SignalStatusData.reason = pMsgData[10]; | |
300 | SignalStatusData.requestId = pMsgData[11]; | |
301 | pReceptionData->IsRfLocked = pMsgData[16]; | |
302 | pReceptionData->IsDemodLocked = pMsgData[17]; | |
303 | pReceptionData->ModemState = pMsgData[12]; | |
304 | pReceptionData->SNR = pMsgData[1]; | |
305 | pReceptionData->BER = pMsgData[13]; | |
306 | pReceptionData->RSSI = pMsgData[14]; | |
307 | CORRECT_STAT_RSSI(client->sms_stat_dvb.ReceptionData); | |
308 | ||
309 | pReceptionData->InBandPwr = (s32) pMsgData[2]; | |
310 | pReceptionData->CarrierOffset = (s32) pMsgData[15]; | |
311 | pReceptionData->TotalTSPackets = pMsgData[3]; | |
312 | pReceptionData->ErrorTSPackets = pMsgData[4]; | |
313 | ||
314 | /* TS PER */ | |
315 | if ((SignalStatusData.tsPackets + SignalStatusData.etsPackets) | |
316 | > 0) { | |
317 | pReceptionData->TS_PER = (SignalStatusData.etsPackets | |
318 | * 100) / (SignalStatusData.tsPackets | |
319 | + SignalStatusData.etsPackets); | |
82237416 | 320 | } else { |
793786d1 | 321 | pReceptionData->TS_PER = 0; |
2e5c1ec8 | 322 | } |
82237416 | 323 | |
793786d1 US |
324 | pReceptionData->BERBitCount = pMsgData[18]; |
325 | pReceptionData->BERErrorCount = pMsgData[19]; | |
2e5c1ec8 | 326 | |
793786d1 US |
327 | pReceptionData->MRC_SNR = pMsgData[20]; |
328 | pReceptionData->MRC_InBandPwr = pMsgData[21]; | |
329 | pReceptionData->MRC_RSSI = pMsgData[22]; | |
330 | ||
331 | is_status_update = true; | |
332 | break; | |
333 | } | |
67ae1d26 | 334 | case MSG_SMS_GET_STATISTICS_RES: { |
5eb23975 MCC |
335 | union { |
336 | struct SMSHOSTLIB_STATISTICS_ISDBT_ST isdbt; | |
337 | struct SmsMsgStatisticsInfo_ST dvb; | |
338 | } *p = (void *) (phdr + 1); | |
67ae1d26 MCC |
339 | struct RECEPTION_STATISTICS_S *pReceptionData = |
340 | &client->sms_stat_dvb.ReceptionData; | |
341 | ||
342 | sms_info("MSG_SMS_GET_STATISTICS_RES"); | |
343 | ||
344 | is_status_update = true; | |
5eb23975 MCC |
345 | |
346 | switch (smscore_get_device_mode(client->coredev)) { | |
347 | case DEVICE_MODE_ISDBT: | |
348 | case DEVICE_MODE_ISDBT_BDA: | |
349 | smsdvb_update_isdbt_stats(pReceptionData, &p->isdbt); | |
350 | break; | |
351 | default: | |
352 | smsdvb_update_dvb_stats(pReceptionData, &p->dvb.Stat); | |
353 | } | |
67ae1d26 MCC |
354 | if (!pReceptionData->IsDemodLocked) { |
355 | pReceptionData->SNR = 0; | |
356 | pReceptionData->BER = 0; | |
357 | pReceptionData->BERErrorCount = 0; | |
358 | pReceptionData->InBandPwr = 0; | |
359 | pReceptionData->ErrorTSPackets = 0; | |
67ae1d26 MCC |
360 | } |
361 | ||
67ae1d26 MCC |
362 | complete(&client->tune_done); |
363 | break; | |
364 | } | |
365 | default: | |
366 | sms_info("Unhandled message %d", phdr->msgType); | |
367 | ||
793786d1 | 368 | } |
2e5c1ec8 MK |
369 | smscore_putbuffer(client->coredev, cb); |
370 | ||
793786d1 US |
371 | if (is_status_update) { |
372 | if (client->sms_stat_dvb.ReceptionData.IsDemodLocked) { | |
373 | client->fe_status = FE_HAS_SIGNAL | FE_HAS_CARRIER | |
374 | | FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK; | |
375 | sms_board_dvb3_event(client, DVB3_EVENT_FE_LOCK); | |
376 | if (client->sms_stat_dvb.ReceptionData.ErrorTSPackets | |
377 | == 0) | |
378 | sms_board_dvb3_event(client, DVB3_EVENT_UNC_OK); | |
379 | else | |
380 | sms_board_dvb3_event(client, | |
381 | DVB3_EVENT_UNC_ERR); | |
382 | ||
383 | } else { | |
b4622c14 MCC |
384 | if (client->sms_stat_dvb.ReceptionData.IsRfLocked) |
385 | client->fe_status = FE_HAS_SIGNAL | FE_HAS_CARRIER; | |
386 | else | |
387 | client->fe_status = 0; | |
793786d1 US |
388 | sms_board_dvb3_event(client, DVB3_EVENT_FE_UNLOCK); |
389 | } | |
390 | } | |
391 | ||
2e5c1ec8 MK |
392 | return 0; |
393 | } | |
394 | ||
0c071f37 | 395 | static void smsdvb_unregister_client(struct smsdvb_client_t *client) |
2e5c1ec8 | 396 | { |
fa830e8a | 397 | /* must be called under clientslock */ |
2e5c1ec8 MK |
398 | |
399 | list_del(&client->entry); | |
400 | ||
401 | smscore_unregister_client(client->smsclient); | |
402 | dvb_unregister_frontend(&client->frontend); | |
403 | dvb_dmxdev_release(&client->dmxdev); | |
404 | dvb_dmx_release(&client->demux); | |
405 | dvb_unregister_adapter(&client->adapter); | |
406 | kfree(client); | |
407 | } | |
408 | ||
0c071f37 | 409 | static void smsdvb_onremove(void *context) |
2e5c1ec8 MK |
410 | { |
411 | kmutex_lock(&g_smsdvb_clientslock); | |
412 | ||
18245e18 | 413 | smsdvb_unregister_client((struct smsdvb_client_t *) context); |
2e5c1ec8 MK |
414 | |
415 | kmutex_unlock(&g_smsdvb_clientslock); | |
416 | } | |
417 | ||
418 | static int smsdvb_start_feed(struct dvb_demux_feed *feed) | |
419 | { | |
18245e18 MK |
420 | struct smsdvb_client_t *client = |
421 | container_of(feed->demux, struct smsdvb_client_t, demux); | |
422 | struct SmsMsgData_ST PidMsg; | |
2e5c1ec8 | 423 | |
a0c0abcb | 424 | sms_debug("add pid %d(%x)", |
068d6c0f | 425 | feed->pid, feed->pid); |
2e5c1ec8 MK |
426 | |
427 | PidMsg.xMsgHeader.msgSrcId = DVBT_BDA_CONTROL_MSG_ID; | |
428 | PidMsg.xMsgHeader.msgDstId = HIF_TASK; | |
429 | PidMsg.xMsgHeader.msgFlags = 0; | |
430 | PidMsg.xMsgHeader.msgType = MSG_SMS_ADD_PID_FILTER_REQ; | |
431 | PidMsg.xMsgHeader.msgLength = sizeof(PidMsg); | |
432 | PidMsg.msgData[0] = feed->pid; | |
433 | ||
ba79bb2c | 434 | smsendian_handle_tx_message((struct SmsMsgHdr_ST *)&PidMsg); |
82237416 MK |
435 | return smsclient_sendrequest(client->smsclient, |
436 | &PidMsg, sizeof(PidMsg)); | |
2e5c1ec8 MK |
437 | } |
438 | ||
439 | static int smsdvb_stop_feed(struct dvb_demux_feed *feed) | |
440 | { | |
18245e18 MK |
441 | struct smsdvb_client_t *client = |
442 | container_of(feed->demux, struct smsdvb_client_t, demux); | |
443 | struct SmsMsgData_ST PidMsg; | |
2e5c1ec8 | 444 | |
a0c0abcb | 445 | sms_debug("remove pid %d(%x)", |
068d6c0f | 446 | feed->pid, feed->pid); |
2e5c1ec8 MK |
447 | |
448 | PidMsg.xMsgHeader.msgSrcId = DVBT_BDA_CONTROL_MSG_ID; | |
449 | PidMsg.xMsgHeader.msgDstId = HIF_TASK; | |
450 | PidMsg.xMsgHeader.msgFlags = 0; | |
451 | PidMsg.xMsgHeader.msgType = MSG_SMS_REMOVE_PID_FILTER_REQ; | |
452 | PidMsg.xMsgHeader.msgLength = sizeof(PidMsg); | |
453 | PidMsg.msgData[0] = feed->pid; | |
454 | ||
ba79bb2c | 455 | smsendian_handle_tx_message((struct SmsMsgHdr_ST *)&PidMsg); |
82237416 MK |
456 | return smsclient_sendrequest(client->smsclient, |
457 | &PidMsg, sizeof(PidMsg)); | |
2e5c1ec8 MK |
458 | } |
459 | ||
18245e18 | 460 | static int smsdvb_sendrequest_and_wait(struct smsdvb_client_t *client, |
a83ccdd6 MK |
461 | void *buffer, size_t size, |
462 | struct completion *completion) | |
2e5c1ec8 | 463 | { |
ba79bb2c US |
464 | int rc; |
465 | ||
466 | smsendian_handle_tx_message((struct SmsMsgHdr_ST *)buffer); | |
467 | rc = smsclient_sendrequest(client->smsclient, buffer, size); | |
2e5c1ec8 MK |
468 | if (rc < 0) |
469 | return rc; | |
470 | ||
82237416 MK |
471 | return wait_for_completion_timeout(completion, |
472 | msecs_to_jiffies(2000)) ? | |
473 | 0 : -ETIME; | |
2e5c1ec8 MK |
474 | } |
475 | ||
67ae1d26 MCC |
476 | static int smsdvb_send_statistics_request(struct smsdvb_client_t *client) |
477 | { | |
478 | int rc; | |
479 | struct SmsMsgHdr_ST Msg = { MSG_SMS_GET_STATISTICS_REQ, | |
480 | DVBT_BDA_CONTROL_MSG_ID, | |
481 | HIF_TASK, | |
482 | sizeof(struct SmsMsgHdr_ST), 0 }; | |
483 | ||
484 | rc = smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), | |
485 | &client->tune_done); | |
486 | ||
487 | return rc; | |
488 | } | |
489 | ||
3746b617 MK |
490 | static inline int led_feedback(struct smsdvb_client_t *client) |
491 | { | |
492 | if (client->fe_status & FE_HAS_LOCK) | |
493 | return sms_board_led_feedback(client->coredev, | |
494 | (client->sms_stat_dvb.ReceptionData.BER | |
495 | == 0) ? SMS_LED_HI : SMS_LED_LO); | |
496 | else | |
497 | return sms_board_led_feedback(client->coredev, SMS_LED_OFF); | |
498 | } | |
499 | ||
2e5c1ec8 MK |
500 | static int smsdvb_read_status(struct dvb_frontend *fe, fe_status_t *stat) |
501 | { | |
67ae1d26 | 502 | int rc; |
793786d1 US |
503 | struct smsdvb_client_t *client; |
504 | client = container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 505 | |
67ae1d26 MCC |
506 | rc = smsdvb_send_statistics_request(client); |
507 | ||
793786d1 | 508 | *stat = client->fe_status; |
2e5c1ec8 | 509 | |
3746b617 MK |
510 | led_feedback(client); |
511 | ||
67ae1d26 | 512 | return rc; |
2e5c1ec8 MK |
513 | } |
514 | ||
515 | static int smsdvb_read_ber(struct dvb_frontend *fe, u32 *ber) | |
516 | { | |
67ae1d26 | 517 | int rc; |
793786d1 US |
518 | struct smsdvb_client_t *client; |
519 | client = container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 520 | |
67ae1d26 MCC |
521 | rc = smsdvb_send_statistics_request(client); |
522 | ||
793786d1 | 523 | *ber = client->sms_stat_dvb.ReceptionData.BER; |
2e5c1ec8 | 524 | |
3746b617 MK |
525 | led_feedback(client); |
526 | ||
67ae1d26 | 527 | return rc; |
2e5c1ec8 MK |
528 | } |
529 | ||
530 | static int smsdvb_read_signal_strength(struct dvb_frontend *fe, u16 *strength) | |
531 | { | |
67ae1d26 MCC |
532 | int rc; |
533 | ||
793786d1 US |
534 | struct smsdvb_client_t *client; |
535 | client = container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 536 | |
67ae1d26 MCC |
537 | rc = smsdvb_send_statistics_request(client); |
538 | ||
793786d1 US |
539 | if (client->sms_stat_dvb.ReceptionData.InBandPwr < -95) |
540 | *strength = 0; | |
541 | else if (client->sms_stat_dvb.ReceptionData.InBandPwr > -29) | |
542 | *strength = 100; | |
543 | else | |
544 | *strength = | |
545 | (client->sms_stat_dvb.ReceptionData.InBandPwr | |
546 | + 95) * 3 / 2; | |
2e5c1ec8 | 547 | |
3746b617 MK |
548 | led_feedback(client); |
549 | ||
67ae1d26 | 550 | return rc; |
2e5c1ec8 MK |
551 | } |
552 | ||
553 | static int smsdvb_read_snr(struct dvb_frontend *fe, u16 *snr) | |
554 | { | |
67ae1d26 | 555 | int rc; |
793786d1 US |
556 | struct smsdvb_client_t *client; |
557 | client = container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 558 | |
67ae1d26 MCC |
559 | rc = smsdvb_send_statistics_request(client); |
560 | ||
793786d1 | 561 | *snr = client->sms_stat_dvb.ReceptionData.SNR; |
2e5c1ec8 | 562 | |
3746b617 MK |
563 | led_feedback(client); |
564 | ||
67ae1d26 | 565 | return rc; |
2e5c1ec8 MK |
566 | } |
567 | ||
851a9091 MK |
568 | static int smsdvb_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) |
569 | { | |
67ae1d26 | 570 | int rc; |
793786d1 US |
571 | struct smsdvb_client_t *client; |
572 | client = container_of(fe, struct smsdvb_client_t, frontend); | |
851a9091 | 573 | |
67ae1d26 MCC |
574 | rc = smsdvb_send_statistics_request(client); |
575 | ||
793786d1 | 576 | *ucblocks = client->sms_stat_dvb.ReceptionData.ErrorTSPackets; |
851a9091 | 577 | |
3746b617 MK |
578 | led_feedback(client); |
579 | ||
67ae1d26 | 580 | return rc; |
851a9091 MK |
581 | } |
582 | ||
82237416 MK |
583 | static int smsdvb_get_tune_settings(struct dvb_frontend *fe, |
584 | struct dvb_frontend_tune_settings *tune) | |
2e5c1ec8 | 585 | { |
a0c0abcb | 586 | sms_debug(""); |
2e5c1ec8 MK |
587 | |
588 | tune->min_delay_ms = 400; | |
589 | tune->step_size = 250000; | |
590 | tune->max_drift = 0; | |
591 | return 0; | |
592 | } | |
593 | ||
6b26fcea | 594 | static int smsdvb_dvbt_set_frontend(struct dvb_frontend *fe, |
cf4fab72 | 595 | struct dvb_frontend_parameters *p) |
2e5c1ec8 | 596 | { |
cf4fab72 | 597 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
18245e18 MK |
598 | struct smsdvb_client_t *client = |
599 | container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 600 | |
18245e18 MK |
601 | struct { |
602 | struct SmsMsgHdr_ST Msg; | |
82237416 | 603 | u32 Data[3]; |
2e5c1ec8 MK |
604 | } Msg; |
605 | ||
3746b617 MK |
606 | int ret; |
607 | ||
793786d1 US |
608 | client->fe_status = FE_HAS_SIGNAL; |
609 | client->event_fe_state = -1; | |
610 | client->event_unc_state = -1; | |
e85c97a0 | 611 | fe->dtv_property_cache.delivery_system = SYS_DVBT; |
793786d1 US |
612 | |
613 | Msg.Msg.msgSrcId = DVBT_BDA_CONTROL_MSG_ID; | |
614 | Msg.Msg.msgDstId = HIF_TASK; | |
615 | Msg.Msg.msgFlags = 0; | |
616 | Msg.Msg.msgType = MSG_SMS_RF_TUNE_REQ; | |
2e5c1ec8 | 617 | Msg.Msg.msgLength = sizeof(Msg); |
cf4fab72 | 618 | Msg.Data[0] = c->frequency; |
2e5c1ec8 MK |
619 | Msg.Data[2] = 12000000; |
620 | ||
cf4fab72 MCC |
621 | sms_info("%s: freq %d band %d", __func__, c->frequency, |
622 | c->bandwidth_hz); | |
2e5c1ec8 | 623 | |
643e15a0 | 624 | switch (c->bandwidth_hz / 1000000) { |
cf4fab72 MCC |
625 | case 8: |
626 | Msg.Data[1] = BW_8_MHZ; | |
627 | break; | |
628 | case 7: | |
629 | Msg.Data[1] = BW_7_MHZ; | |
630 | break; | |
631 | case 6: | |
632 | Msg.Data[1] = BW_6_MHZ; | |
633 | break; | |
634 | case 0: | |
635 | return -EOPNOTSUPP; | |
636 | default: | |
637 | return -EINVAL; | |
2e5c1ec8 | 638 | } |
3746b617 MK |
639 | /* Disable LNA, if any. An error is returned if no LNA is present */ |
640 | ret = sms_board_lna_control(client->coredev, 0); | |
641 | if (ret == 0) { | |
642 | fe_status_t status; | |
643 | ||
644 | /* tune with LNA off at first */ | |
645 | ret = smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), | |
646 | &client->tune_done); | |
647 | ||
648 | smsdvb_read_status(fe, &status); | |
649 | ||
650 | if (status & FE_HAS_LOCK) | |
651 | return ret; | |
652 | ||
653 | /* previous tune didnt lock - enable LNA and tune again */ | |
654 | sms_board_lna_control(client->coredev, 1); | |
655 | } | |
2e5c1ec8 | 656 | |
82237416 MK |
657 | return smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), |
658 | &client->tune_done); | |
2e5c1ec8 MK |
659 | } |
660 | ||
6b26fcea | 661 | static int smsdvb_isdbt_set_frontend(struct dvb_frontend *fe, |
cf4fab72 | 662 | struct dvb_frontend_parameters *p) |
6b26fcea | 663 | { |
cf4fab72 | 664 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
6b26fcea MK |
665 | struct smsdvb_client_t *client = |
666 | container_of(fe, struct smsdvb_client_t, frontend); | |
667 | ||
668 | struct { | |
669 | struct SmsMsgHdr_ST Msg; | |
670 | u32 Data[4]; | |
671 | } Msg; | |
672 | ||
e85c97a0 MCC |
673 | fe->dtv_property_cache.delivery_system = SYS_ISDBT; |
674 | ||
6b26fcea MK |
675 | Msg.Msg.msgSrcId = DVBT_BDA_CONTROL_MSG_ID; |
676 | Msg.Msg.msgDstId = HIF_TASK; | |
677 | Msg.Msg.msgFlags = 0; | |
678 | Msg.Msg.msgType = MSG_SMS_ISDBT_TUNE_REQ; | |
679 | Msg.Msg.msgLength = sizeof(Msg); | |
6b26fcea | 680 | |
cf4fab72 MCC |
681 | if (c->isdbt_sb_segment_idx == -1) |
682 | c->isdbt_sb_segment_idx = 0; | |
6b26fcea | 683 | |
cf4fab72 MCC |
684 | switch (c->isdbt_sb_segment_count) { |
685 | case 3: | |
6b26fcea MK |
686 | Msg.Data[1] = BW_ISDBT_3SEG; |
687 | break; | |
cf4fab72 | 688 | case 1: |
6b26fcea MK |
689 | Msg.Data[1] = BW_ISDBT_1SEG; |
690 | break; | |
cf4fab72 | 691 | case 0: /* AUTO */ |
643e15a0 | 692 | switch (c->bandwidth_hz / 1000000) { |
cf4fab72 MCC |
693 | case 8: |
694 | case 7: | |
695 | c->isdbt_sb_segment_count = 3; | |
696 | Msg.Data[1] = BW_ISDBT_3SEG; | |
697 | break; | |
698 | case 6: | |
699 | c->isdbt_sb_segment_count = 1; | |
700 | Msg.Data[1] = BW_ISDBT_1SEG; | |
701 | break; | |
702 | default: /* Assumes 6 MHZ bw */ | |
703 | c->isdbt_sb_segment_count = 1; | |
704 | c->bandwidth_hz = 6000; | |
705 | Msg.Data[1] = BW_ISDBT_1SEG; | |
706 | break; | |
707 | } | |
708 | break; | |
6b26fcea | 709 | default: |
cf4fab72 | 710 | sms_info("Segment count %d not supported", c->isdbt_sb_segment_count); |
6b26fcea MK |
711 | return -EINVAL; |
712 | } | |
713 | ||
cf4fab72 MCC |
714 | Msg.Data[0] = c->frequency; |
715 | Msg.Data[2] = 12000000; | |
716 | Msg.Data[3] = c->isdbt_sb_segment_idx; | |
717 | ||
718 | sms_info("%s: freq %d segwidth %d segindex %d\n", __func__, | |
719 | c->frequency, c->isdbt_sb_segment_count, | |
720 | c->isdbt_sb_segment_idx); | |
721 | ||
6b26fcea MK |
722 | return smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), |
723 | &client->tune_done); | |
724 | } | |
725 | ||
726 | static int smsdvb_set_frontend(struct dvb_frontend *fe, | |
727 | struct dvb_frontend_parameters *fep) | |
728 | { | |
729 | struct smsdvb_client_t *client = | |
730 | container_of(fe, struct smsdvb_client_t, frontend); | |
731 | struct smscore_device_t *coredev = client->coredev; | |
732 | ||
733 | switch (smscore_get_device_mode(coredev)) { | |
734 | case DEVICE_MODE_DVBT: | |
735 | case DEVICE_MODE_DVBT_BDA: | |
736 | return smsdvb_dvbt_set_frontend(fe, fep); | |
737 | case DEVICE_MODE_ISDBT: | |
738 | case DEVICE_MODE_ISDBT_BDA: | |
cf4fab72 | 739 | return smsdvb_isdbt_set_frontend(fe, fep); |
6b26fcea MK |
740 | default: |
741 | return -EINVAL; | |
742 | } | |
743 | } | |
744 | ||
82237416 MK |
745 | static int smsdvb_get_frontend(struct dvb_frontend *fe, |
746 | struct dvb_frontend_parameters *fep) | |
2e5c1ec8 | 747 | { |
18245e18 MK |
748 | struct smsdvb_client_t *client = |
749 | container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 750 | |
a0c0abcb | 751 | sms_debug(""); |
2e5c1ec8 | 752 | |
fa830e8a | 753 | /* todo: */ |
82237416 MK |
754 | memcpy(fep, &client->fe_params, |
755 | sizeof(struct dvb_frontend_parameters)); | |
7a6fbed6 MK |
756 | |
757 | return 0; | |
758 | } | |
759 | ||
760 | static int smsdvb_init(struct dvb_frontend *fe) | |
761 | { | |
762 | struct smsdvb_client_t *client = | |
763 | container_of(fe, struct smsdvb_client_t, frontend); | |
764 | ||
3746b617 MK |
765 | sms_board_power(client->coredev, 1); |
766 | ||
793786d1 | 767 | sms_board_dvb3_event(client, DVB3_EVENT_INIT); |
7a6fbed6 MK |
768 | return 0; |
769 | } | |
770 | ||
771 | static int smsdvb_sleep(struct dvb_frontend *fe) | |
772 | { | |
773 | struct smsdvb_client_t *client = | |
774 | container_of(fe, struct smsdvb_client_t, frontend); | |
775 | ||
3746b617 MK |
776 | sms_board_led_feedback(client->coredev, SMS_LED_OFF); |
777 | sms_board_power(client->coredev, 0); | |
778 | ||
793786d1 | 779 | sms_board_dvb3_event(client, DVB3_EVENT_SLEEP); |
7a6fbed6 | 780 | |
2e5c1ec8 MK |
781 | return 0; |
782 | } | |
783 | ||
784 | static void smsdvb_release(struct dvb_frontend *fe) | |
785 | { | |
fa830e8a | 786 | /* do nothing */ |
2e5c1ec8 MK |
787 | } |
788 | ||
789 | static struct dvb_frontend_ops smsdvb_fe_ops = { | |
790 | .info = { | |
e0f14c25 | 791 | .name = "Siano Mobile Digital MDTV Receiver", |
82237416 | 792 | .type = FE_OFDM, |
2e5c1ec8 MK |
793 | .frequency_min = 44250000, |
794 | .frequency_max = 867250000, | |
795 | .frequency_stepsize = 250000, | |
796 | .caps = FE_CAN_INVERSION_AUTO | | |
82237416 MK |
797 | FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | |
798 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO | | |
799 | FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | | |
800 | FE_CAN_QAM_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO | | |
801 | FE_CAN_GUARD_INTERVAL_AUTO | | |
802 | FE_CAN_RECOVER | | |
803 | FE_CAN_HIERARCHY_AUTO, | |
2e5c1ec8 MK |
804 | }, |
805 | ||
806 | .release = smsdvb_release, | |
807 | ||
808 | .set_frontend = smsdvb_set_frontend, | |
809 | .get_frontend = smsdvb_get_frontend, | |
810 | .get_tune_settings = smsdvb_get_tune_settings, | |
811 | ||
812 | .read_status = smsdvb_read_status, | |
813 | .read_ber = smsdvb_read_ber, | |
814 | .read_signal_strength = smsdvb_read_signal_strength, | |
815 | .read_snr = smsdvb_read_snr, | |
851a9091 | 816 | .read_ucblocks = smsdvb_read_ucblocks, |
7a6fbed6 MK |
817 | |
818 | .init = smsdvb_init, | |
819 | .sleep = smsdvb_sleep, | |
2e5c1ec8 MK |
820 | }; |
821 | ||
0c071f37 MK |
822 | static int smsdvb_hotplug(struct smscore_device_t *coredev, |
823 | struct device *device, int arrival) | |
2e5c1ec8 | 824 | { |
18245e18 MK |
825 | struct smsclient_params_t params; |
826 | struct smsdvb_client_t *client; | |
2e5c1ec8 MK |
827 | int rc; |
828 | ||
fa830e8a | 829 | /* device removal handled by onremove callback */ |
2e5c1ec8 MK |
830 | if (!arrival) |
831 | return 0; | |
18245e18 | 832 | client = kzalloc(sizeof(struct smsdvb_client_t), GFP_KERNEL); |
82237416 | 833 | if (!client) { |
eb250942 | 834 | sms_err("kmalloc() failed"); |
2e5c1ec8 MK |
835 | return -ENOMEM; |
836 | } | |
837 | ||
fa830e8a | 838 | /* register dvb adapter */ |
1c11d546 MK |
839 | rc = dvb_register_adapter(&client->adapter, |
840 | sms_get_board( | |
841 | smscore_get_board_id(coredev))->name, | |
82237416 MK |
842 | THIS_MODULE, device, adapter_nr); |
843 | if (rc < 0) { | |
a0c0abcb | 844 | sms_err("dvb_register_adapter() failed %d", rc); |
2e5c1ec8 MK |
845 | goto adapter_error; |
846 | } | |
847 | ||
fa830e8a | 848 | /* init dvb demux */ |
2e5c1ec8 | 849 | client->demux.dmx.capabilities = DMX_TS_FILTERING; |
fa830e8a | 850 | client->demux.filternum = 32; /* todo: nova ??? */ |
2e5c1ec8 MK |
851 | client->demux.feednum = 32; |
852 | client->demux.start_feed = smsdvb_start_feed; | |
853 | client->demux.stop_feed = smsdvb_stop_feed; | |
854 | ||
855 | rc = dvb_dmx_init(&client->demux); | |
82237416 | 856 | if (rc < 0) { |
a0c0abcb | 857 | sms_err("dvb_dmx_init failed %d", rc); |
2e5c1ec8 MK |
858 | goto dvbdmx_error; |
859 | } | |
860 | ||
fa830e8a | 861 | /* init dmxdev */ |
2e5c1ec8 MK |
862 | client->dmxdev.filternum = 32; |
863 | client->dmxdev.demux = &client->demux.dmx; | |
864 | client->dmxdev.capabilities = 0; | |
865 | ||
866 | rc = dvb_dmxdev_init(&client->dmxdev, &client->adapter); | |
82237416 | 867 | if (rc < 0) { |
a0c0abcb | 868 | sms_err("dvb_dmxdev_init failed %d", rc); |
2e5c1ec8 MK |
869 | goto dmxdev_error; |
870 | } | |
871 | ||
fa830e8a | 872 | /* init and register frontend */ |
82237416 MK |
873 | memcpy(&client->frontend.ops, &smsdvb_fe_ops, |
874 | sizeof(struct dvb_frontend_ops)); | |
2e5c1ec8 MK |
875 | |
876 | rc = dvb_register_frontend(&client->adapter, &client->frontend); | |
82237416 | 877 | if (rc < 0) { |
a0c0abcb | 878 | sms_err("frontend registration failed %d", rc); |
2e5c1ec8 MK |
879 | goto frontend_error; |
880 | } | |
881 | ||
f17407a8 | 882 | params.initial_id = 1; |
2e5c1ec8 MK |
883 | params.data_type = MSG_SMS_DVBT_BDA_DATA; |
884 | params.onresponse_handler = smsdvb_onresponse; | |
885 | params.onremove_handler = smsdvb_onremove; | |
886 | params.context = client; | |
887 | ||
888 | rc = smscore_register_client(coredev, ¶ms, &client->smsclient); | |
82237416 | 889 | if (rc < 0) { |
eb250942 | 890 | sms_err("smscore_register_client() failed %d", rc); |
2e5c1ec8 MK |
891 | goto client_error; |
892 | } | |
893 | ||
894 | client->coredev = coredev; | |
895 | ||
896 | init_completion(&client->tune_done); | |
2e5c1ec8 MK |
897 | |
898 | kmutex_lock(&g_smsdvb_clientslock); | |
899 | ||
900 | list_add(&client->entry, &g_smsdvb_clients); | |
901 | ||
902 | kmutex_unlock(&g_smsdvb_clientslock); | |
903 | ||
793786d1 US |
904 | client->event_fe_state = -1; |
905 | client->event_unc_state = -1; | |
906 | sms_board_dvb3_event(client, DVB3_EVENT_HOTPLUG); | |
2e5c1ec8 | 907 | |
793786d1 | 908 | sms_info("success"); |
250fa674 MK |
909 | sms_board_setup(coredev); |
910 | ||
2e5c1ec8 MK |
911 | return 0; |
912 | ||
913 | client_error: | |
914 | dvb_unregister_frontend(&client->frontend); | |
915 | ||
916 | frontend_error: | |
917 | dvb_dmxdev_release(&client->dmxdev); | |
918 | ||
919 | dmxdev_error: | |
920 | dvb_dmx_release(&client->demux); | |
921 | ||
922 | dvbdmx_error: | |
923 | dvb_unregister_adapter(&client->adapter); | |
924 | ||
925 | adapter_error: | |
926 | kfree(client); | |
927 | return rc; | |
928 | } | |
929 | ||
2184dda0 | 930 | static int __init smsdvb_module_init(void) |
eae55660 ST |
931 | { |
932 | int rc; | |
933 | ||
934 | INIT_LIST_HEAD(&g_smsdvb_clients); | |
935 | kmutex_init(&g_smsdvb_clientslock); | |
936 | ||
937 | rc = smscore_register_hotplug(smsdvb_hotplug); | |
938 | ||
a0c0abcb | 939 | sms_debug(""); |
eae55660 ST |
940 | |
941 | return rc; | |
942 | } | |
943 | ||
2184dda0 | 944 | static void __exit smsdvb_module_exit(void) |
eae55660 ST |
945 | { |
946 | smscore_unregister_hotplug(smsdvb_hotplug); | |
947 | ||
948 | kmutex_lock(&g_smsdvb_clientslock); | |
949 | ||
950 | while (!list_empty(&g_smsdvb_clients)) | |
82237416 | 951 | smsdvb_unregister_client( |
18245e18 | 952 | (struct smsdvb_client_t *) g_smsdvb_clients.next); |
eae55660 ST |
953 | |
954 | kmutex_unlock(&g_smsdvb_clientslock); | |
eae55660 | 955 | } |
e0f14c25 US |
956 | |
957 | module_init(smsdvb_module_init); | |
958 | module_exit(smsdvb_module_exit); | |
959 | ||
960 | MODULE_DESCRIPTION("SMS DVB subsystem adaptation module"); | |
843d0605 | 961 | MODULE_AUTHOR("Siano Mobile Silicon, Inc. (uris@siano-ms.com)"); |
e0f14c25 | 962 | MODULE_LICENSE("GPL"); |