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 */ | |
15115c17 | 53 | struct dtv_frontend_properties 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 | ||
15115c17 | 594 | static int smsdvb_dvbt_set_frontend(struct dvb_frontend *fe) |
2e5c1ec8 | 595 | { |
cf4fab72 | 596 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
18245e18 MK |
597 | struct smsdvb_client_t *client = |
598 | container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 599 | |
18245e18 MK |
600 | struct { |
601 | struct SmsMsgHdr_ST Msg; | |
82237416 | 602 | u32 Data[3]; |
2e5c1ec8 MK |
603 | } Msg; |
604 | ||
3746b617 MK |
605 | int ret; |
606 | ||
793786d1 US |
607 | client->fe_status = FE_HAS_SIGNAL; |
608 | client->event_fe_state = -1; | |
609 | client->event_unc_state = -1; | |
e85c97a0 | 610 | fe->dtv_property_cache.delivery_system = SYS_DVBT; |
793786d1 US |
611 | |
612 | Msg.Msg.msgSrcId = DVBT_BDA_CONTROL_MSG_ID; | |
613 | Msg.Msg.msgDstId = HIF_TASK; | |
614 | Msg.Msg.msgFlags = 0; | |
615 | Msg.Msg.msgType = MSG_SMS_RF_TUNE_REQ; | |
2e5c1ec8 | 616 | Msg.Msg.msgLength = sizeof(Msg); |
cf4fab72 | 617 | Msg.Data[0] = c->frequency; |
2e5c1ec8 MK |
618 | Msg.Data[2] = 12000000; |
619 | ||
cf4fab72 MCC |
620 | sms_info("%s: freq %d band %d", __func__, c->frequency, |
621 | c->bandwidth_hz); | |
2e5c1ec8 | 622 | |
643e15a0 | 623 | switch (c->bandwidth_hz / 1000000) { |
cf4fab72 MCC |
624 | case 8: |
625 | Msg.Data[1] = BW_8_MHZ; | |
626 | break; | |
627 | case 7: | |
628 | Msg.Data[1] = BW_7_MHZ; | |
629 | break; | |
630 | case 6: | |
631 | Msg.Data[1] = BW_6_MHZ; | |
632 | break; | |
633 | case 0: | |
634 | return -EOPNOTSUPP; | |
635 | default: | |
636 | return -EINVAL; | |
2e5c1ec8 | 637 | } |
3746b617 MK |
638 | /* Disable LNA, if any. An error is returned if no LNA is present */ |
639 | ret = sms_board_lna_control(client->coredev, 0); | |
640 | if (ret == 0) { | |
641 | fe_status_t status; | |
642 | ||
643 | /* tune with LNA off at first */ | |
644 | ret = smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), | |
645 | &client->tune_done); | |
646 | ||
647 | smsdvb_read_status(fe, &status); | |
648 | ||
649 | if (status & FE_HAS_LOCK) | |
650 | return ret; | |
651 | ||
25985edc | 652 | /* previous tune didn't lock - enable LNA and tune again */ |
3746b617 MK |
653 | sms_board_lna_control(client->coredev, 1); |
654 | } | |
2e5c1ec8 | 655 | |
82237416 MK |
656 | return smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), |
657 | &client->tune_done); | |
2e5c1ec8 MK |
658 | } |
659 | ||
15115c17 | 660 | static int smsdvb_isdbt_set_frontend(struct dvb_frontend *fe) |
6b26fcea | 661 | { |
cf4fab72 | 662 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
6b26fcea MK |
663 | struct smsdvb_client_t *client = |
664 | container_of(fe, struct smsdvb_client_t, frontend); | |
665 | ||
666 | struct { | |
667 | struct SmsMsgHdr_ST Msg; | |
668 | u32 Data[4]; | |
669 | } Msg; | |
670 | ||
e85c97a0 MCC |
671 | fe->dtv_property_cache.delivery_system = SYS_ISDBT; |
672 | ||
6b26fcea MK |
673 | Msg.Msg.msgSrcId = DVBT_BDA_CONTROL_MSG_ID; |
674 | Msg.Msg.msgDstId = HIF_TASK; | |
675 | Msg.Msg.msgFlags = 0; | |
676 | Msg.Msg.msgType = MSG_SMS_ISDBT_TUNE_REQ; | |
677 | Msg.Msg.msgLength = sizeof(Msg); | |
6b26fcea | 678 | |
cf4fab72 MCC |
679 | if (c->isdbt_sb_segment_idx == -1) |
680 | c->isdbt_sb_segment_idx = 0; | |
6b26fcea | 681 | |
cf4fab72 MCC |
682 | switch (c->isdbt_sb_segment_count) { |
683 | case 3: | |
6b26fcea MK |
684 | Msg.Data[1] = BW_ISDBT_3SEG; |
685 | break; | |
cf4fab72 | 686 | case 1: |
6b26fcea MK |
687 | Msg.Data[1] = BW_ISDBT_1SEG; |
688 | break; | |
cf4fab72 | 689 | case 0: /* AUTO */ |
643e15a0 | 690 | switch (c->bandwidth_hz / 1000000) { |
cf4fab72 MCC |
691 | case 8: |
692 | case 7: | |
693 | c->isdbt_sb_segment_count = 3; | |
694 | Msg.Data[1] = BW_ISDBT_3SEG; | |
695 | break; | |
696 | case 6: | |
697 | c->isdbt_sb_segment_count = 1; | |
698 | Msg.Data[1] = BW_ISDBT_1SEG; | |
699 | break; | |
700 | default: /* Assumes 6 MHZ bw */ | |
701 | c->isdbt_sb_segment_count = 1; | |
702 | c->bandwidth_hz = 6000; | |
703 | Msg.Data[1] = BW_ISDBT_1SEG; | |
704 | break; | |
705 | } | |
706 | break; | |
6b26fcea | 707 | default: |
cf4fab72 | 708 | sms_info("Segment count %d not supported", c->isdbt_sb_segment_count); |
6b26fcea MK |
709 | return -EINVAL; |
710 | } | |
711 | ||
cf4fab72 MCC |
712 | Msg.Data[0] = c->frequency; |
713 | Msg.Data[2] = 12000000; | |
714 | Msg.Data[3] = c->isdbt_sb_segment_idx; | |
715 | ||
716 | sms_info("%s: freq %d segwidth %d segindex %d\n", __func__, | |
717 | c->frequency, c->isdbt_sb_segment_count, | |
718 | c->isdbt_sb_segment_idx); | |
719 | ||
6b26fcea MK |
720 | return smsdvb_sendrequest_and_wait(client, &Msg, sizeof(Msg), |
721 | &client->tune_done); | |
722 | } | |
723 | ||
15115c17 | 724 | static int smsdvb_set_frontend(struct dvb_frontend *fe) |
6b26fcea MK |
725 | { |
726 | struct smsdvb_client_t *client = | |
727 | container_of(fe, struct smsdvb_client_t, frontend); | |
728 | struct smscore_device_t *coredev = client->coredev; | |
729 | ||
730 | switch (smscore_get_device_mode(coredev)) { | |
731 | case DEVICE_MODE_DVBT: | |
732 | case DEVICE_MODE_DVBT_BDA: | |
15115c17 | 733 | return smsdvb_dvbt_set_frontend(fe); |
6b26fcea MK |
734 | case DEVICE_MODE_ISDBT: |
735 | case DEVICE_MODE_ISDBT_BDA: | |
15115c17 | 736 | return smsdvb_isdbt_set_frontend(fe); |
6b26fcea MK |
737 | default: |
738 | return -EINVAL; | |
739 | } | |
740 | } | |
741 | ||
7c61d80a | 742 | static int smsdvb_get_frontend(struct dvb_frontend *fe) |
2e5c1ec8 | 743 | { |
7c61d80a | 744 | struct dtv_frontend_properties *fep = &fe->dtv_property_cache; |
18245e18 MK |
745 | struct smsdvb_client_t *client = |
746 | container_of(fe, struct smsdvb_client_t, frontend); | |
2e5c1ec8 | 747 | |
a0c0abcb | 748 | sms_debug(""); |
2e5c1ec8 | 749 | |
fa830e8a | 750 | /* todo: */ |
82237416 | 751 | memcpy(fep, &client->fe_params, |
15115c17 | 752 | sizeof(struct dtv_frontend_properties)); |
7a6fbed6 MK |
753 | |
754 | return 0; | |
755 | } | |
756 | ||
757 | static int smsdvb_init(struct dvb_frontend *fe) | |
758 | { | |
759 | struct smsdvb_client_t *client = | |
760 | container_of(fe, struct smsdvb_client_t, frontend); | |
761 | ||
3746b617 MK |
762 | sms_board_power(client->coredev, 1); |
763 | ||
793786d1 | 764 | sms_board_dvb3_event(client, DVB3_EVENT_INIT); |
7a6fbed6 MK |
765 | return 0; |
766 | } | |
767 | ||
768 | static int smsdvb_sleep(struct dvb_frontend *fe) | |
769 | { | |
770 | struct smsdvb_client_t *client = | |
771 | container_of(fe, struct smsdvb_client_t, frontend); | |
772 | ||
3746b617 MK |
773 | sms_board_led_feedback(client->coredev, SMS_LED_OFF); |
774 | sms_board_power(client->coredev, 0); | |
775 | ||
793786d1 | 776 | sms_board_dvb3_event(client, DVB3_EVENT_SLEEP); |
7a6fbed6 | 777 | |
2e5c1ec8 MK |
778 | return 0; |
779 | } | |
780 | ||
781 | static void smsdvb_release(struct dvb_frontend *fe) | |
782 | { | |
fa830e8a | 783 | /* do nothing */ |
2e5c1ec8 MK |
784 | } |
785 | ||
786 | static struct dvb_frontend_ops smsdvb_fe_ops = { | |
787 | .info = { | |
e0f14c25 | 788 | .name = "Siano Mobile Digital MDTV Receiver", |
82237416 | 789 | .type = FE_OFDM, |
2e5c1ec8 MK |
790 | .frequency_min = 44250000, |
791 | .frequency_max = 867250000, | |
792 | .frequency_stepsize = 250000, | |
793 | .caps = FE_CAN_INVERSION_AUTO | | |
82237416 MK |
794 | FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | |
795 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO | | |
796 | FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | | |
797 | FE_CAN_QAM_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO | | |
798 | FE_CAN_GUARD_INTERVAL_AUTO | | |
799 | FE_CAN_RECOVER | | |
800 | FE_CAN_HIERARCHY_AUTO, | |
2e5c1ec8 MK |
801 | }, |
802 | ||
803 | .release = smsdvb_release, | |
804 | ||
15115c17 MCC |
805 | .set_frontend = smsdvb_set_frontend, |
806 | .get_frontend = smsdvb_get_frontend, | |
2e5c1ec8 MK |
807 | .get_tune_settings = smsdvb_get_tune_settings, |
808 | ||
809 | .read_status = smsdvb_read_status, | |
810 | .read_ber = smsdvb_read_ber, | |
811 | .read_signal_strength = smsdvb_read_signal_strength, | |
812 | .read_snr = smsdvb_read_snr, | |
851a9091 | 813 | .read_ucblocks = smsdvb_read_ucblocks, |
7a6fbed6 MK |
814 | |
815 | .init = smsdvb_init, | |
816 | .sleep = smsdvb_sleep, | |
2e5c1ec8 MK |
817 | }; |
818 | ||
0c071f37 MK |
819 | static int smsdvb_hotplug(struct smscore_device_t *coredev, |
820 | struct device *device, int arrival) | |
2e5c1ec8 | 821 | { |
18245e18 MK |
822 | struct smsclient_params_t params; |
823 | struct smsdvb_client_t *client; | |
2e5c1ec8 MK |
824 | int rc; |
825 | ||
fa830e8a | 826 | /* device removal handled by onremove callback */ |
2e5c1ec8 MK |
827 | if (!arrival) |
828 | return 0; | |
18245e18 | 829 | client = kzalloc(sizeof(struct smsdvb_client_t), GFP_KERNEL); |
82237416 | 830 | if (!client) { |
eb250942 | 831 | sms_err("kmalloc() failed"); |
2e5c1ec8 MK |
832 | return -ENOMEM; |
833 | } | |
834 | ||
fa830e8a | 835 | /* register dvb adapter */ |
1c11d546 MK |
836 | rc = dvb_register_adapter(&client->adapter, |
837 | sms_get_board( | |
838 | smscore_get_board_id(coredev))->name, | |
82237416 MK |
839 | THIS_MODULE, device, adapter_nr); |
840 | if (rc < 0) { | |
a0c0abcb | 841 | sms_err("dvb_register_adapter() failed %d", rc); |
2e5c1ec8 MK |
842 | goto adapter_error; |
843 | } | |
844 | ||
fa830e8a | 845 | /* init dvb demux */ |
2e5c1ec8 | 846 | client->demux.dmx.capabilities = DMX_TS_FILTERING; |
fa830e8a | 847 | client->demux.filternum = 32; /* todo: nova ??? */ |
2e5c1ec8 MK |
848 | client->demux.feednum = 32; |
849 | client->demux.start_feed = smsdvb_start_feed; | |
850 | client->demux.stop_feed = smsdvb_stop_feed; | |
851 | ||
852 | rc = dvb_dmx_init(&client->demux); | |
82237416 | 853 | if (rc < 0) { |
a0c0abcb | 854 | sms_err("dvb_dmx_init failed %d", rc); |
2e5c1ec8 MK |
855 | goto dvbdmx_error; |
856 | } | |
857 | ||
fa830e8a | 858 | /* init dmxdev */ |
2e5c1ec8 MK |
859 | client->dmxdev.filternum = 32; |
860 | client->dmxdev.demux = &client->demux.dmx; | |
861 | client->dmxdev.capabilities = 0; | |
862 | ||
863 | rc = dvb_dmxdev_init(&client->dmxdev, &client->adapter); | |
82237416 | 864 | if (rc < 0) { |
a0c0abcb | 865 | sms_err("dvb_dmxdev_init failed %d", rc); |
2e5c1ec8 MK |
866 | goto dmxdev_error; |
867 | } | |
868 | ||
fa830e8a | 869 | /* init and register frontend */ |
82237416 MK |
870 | memcpy(&client->frontend.ops, &smsdvb_fe_ops, |
871 | sizeof(struct dvb_frontend_ops)); | |
2e5c1ec8 | 872 | |
15115c17 MCC |
873 | switch (smscore_get_device_mode(coredev)) { |
874 | case DEVICE_MODE_DVBT: | |
875 | case DEVICE_MODE_DVBT_BDA: | |
876 | smsdvb_fe_ops.delsys[0] = SYS_DVBT; | |
877 | break; | |
878 | case DEVICE_MODE_ISDBT: | |
879 | case DEVICE_MODE_ISDBT_BDA: | |
880 | smsdvb_fe_ops.delsys[0] = SYS_ISDBT; | |
881 | break; | |
882 | } | |
883 | ||
2e5c1ec8 | 884 | rc = dvb_register_frontend(&client->adapter, &client->frontend); |
82237416 | 885 | if (rc < 0) { |
a0c0abcb | 886 | sms_err("frontend registration failed %d", rc); |
2e5c1ec8 MK |
887 | goto frontend_error; |
888 | } | |
889 | ||
f17407a8 | 890 | params.initial_id = 1; |
2e5c1ec8 MK |
891 | params.data_type = MSG_SMS_DVBT_BDA_DATA; |
892 | params.onresponse_handler = smsdvb_onresponse; | |
893 | params.onremove_handler = smsdvb_onremove; | |
894 | params.context = client; | |
895 | ||
896 | rc = smscore_register_client(coredev, ¶ms, &client->smsclient); | |
82237416 | 897 | if (rc < 0) { |
eb250942 | 898 | sms_err("smscore_register_client() failed %d", rc); |
2e5c1ec8 MK |
899 | goto client_error; |
900 | } | |
901 | ||
902 | client->coredev = coredev; | |
903 | ||
904 | init_completion(&client->tune_done); | |
2e5c1ec8 MK |
905 | |
906 | kmutex_lock(&g_smsdvb_clientslock); | |
907 | ||
908 | list_add(&client->entry, &g_smsdvb_clients); | |
909 | ||
910 | kmutex_unlock(&g_smsdvb_clientslock); | |
911 | ||
793786d1 US |
912 | client->event_fe_state = -1; |
913 | client->event_unc_state = -1; | |
914 | sms_board_dvb3_event(client, DVB3_EVENT_HOTPLUG); | |
2e5c1ec8 | 915 | |
793786d1 | 916 | sms_info("success"); |
250fa674 MK |
917 | sms_board_setup(coredev); |
918 | ||
2e5c1ec8 MK |
919 | return 0; |
920 | ||
921 | client_error: | |
922 | dvb_unregister_frontend(&client->frontend); | |
923 | ||
924 | frontend_error: | |
925 | dvb_dmxdev_release(&client->dmxdev); | |
926 | ||
927 | dmxdev_error: | |
928 | dvb_dmx_release(&client->demux); | |
929 | ||
930 | dvbdmx_error: | |
931 | dvb_unregister_adapter(&client->adapter); | |
932 | ||
933 | adapter_error: | |
934 | kfree(client); | |
935 | return rc; | |
936 | } | |
937 | ||
2184dda0 | 938 | static int __init smsdvb_module_init(void) |
eae55660 ST |
939 | { |
940 | int rc; | |
941 | ||
942 | INIT_LIST_HEAD(&g_smsdvb_clients); | |
943 | kmutex_init(&g_smsdvb_clientslock); | |
944 | ||
945 | rc = smscore_register_hotplug(smsdvb_hotplug); | |
946 | ||
a0c0abcb | 947 | sms_debug(""); |
eae55660 ST |
948 | |
949 | return rc; | |
950 | } | |
951 | ||
2184dda0 | 952 | static void __exit smsdvb_module_exit(void) |
eae55660 ST |
953 | { |
954 | smscore_unregister_hotplug(smsdvb_hotplug); | |
955 | ||
956 | kmutex_lock(&g_smsdvb_clientslock); | |
957 | ||
958 | while (!list_empty(&g_smsdvb_clients)) | |
82237416 | 959 | smsdvb_unregister_client( |
18245e18 | 960 | (struct smsdvb_client_t *) g_smsdvb_clients.next); |
eae55660 ST |
961 | |
962 | kmutex_unlock(&g_smsdvb_clientslock); | |
eae55660 | 963 | } |
e0f14c25 US |
964 | |
965 | module_init(smsdvb_module_init); | |
966 | module_exit(smsdvb_module_exit); | |
967 | ||
968 | MODULE_DESCRIPTION("SMS DVB subsystem adaptation module"); | |
843d0605 | 969 | MODULE_AUTHOR("Siano Mobile Silicon, Inc. (uris@siano-ms.com)"); |
e0f14c25 | 970 | MODULE_LICENSE("GPL"); |