| /* |
| * FireSAT DVB driver |
| * |
| * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License as |
| * published by the Free Software Foundation; either version 2 of |
| * the License, or (at your option) any later version. |
| */ |
| |
| #include <linux/errno.h> |
| #include <linux/kernel.h> |
| #include <linux/list.h> |
| #include <linux/spinlock.h> |
| |
| #include <dvb_demux.h> |
| |
| #include <dma.h> |
| #include <iso.h> |
| |
| #include "firesat.h" |
| |
| static void rawiso_activity_cb(struct hpsb_iso *iso); |
| |
| void tear_down_iso_channel(struct firesat *firesat) |
| { |
| if (firesat->iso_handle != NULL) { |
| hpsb_iso_stop(firesat->iso_handle); |
| hpsb_iso_shutdown(firesat->iso_handle); |
| } |
| firesat->iso_handle = NULL; |
| } |
| |
| int setup_iso_channel(struct firesat *firesat) |
| { |
| int result; |
| firesat->iso_handle = |
| hpsb_iso_recv_init(firesat->host, |
| 256 * 200, //data_buf_size, |
| 256, //buf_packets, |
| firesat->isochannel, |
| HPSB_ISO_DMA_DEFAULT, //dma_mode, |
| -1, //stat.config.irq_interval, |
| rawiso_activity_cb); |
| if (firesat->iso_handle == NULL) { |
| printk(KERN_ERR "Cannot initialize iso receive.\n"); |
| return -EINVAL; |
| } |
| result = hpsb_iso_recv_start(firesat->iso_handle, -1, -1, 0); |
| if (result != 0) { |
| printk(KERN_ERR "Cannot start iso receive.\n"); |
| return -EINVAL; |
| } |
| return 0; |
| } |
| |
| static void rawiso_activity_cb(struct hpsb_iso *iso) |
| { |
| unsigned int num; |
| unsigned int i; |
| /* unsigned int j; */ |
| unsigned int packet; |
| unsigned long flags; |
| struct firesat *firesat = NULL; |
| struct firesat *firesat_iterator; |
| |
| spin_lock_irqsave(&firesat_list_lock, flags); |
| list_for_each_entry(firesat_iterator, &firesat_list, list) { |
| if(firesat_iterator->iso_handle == iso) { |
| firesat = firesat_iterator; |
| break; |
| } |
| } |
| spin_unlock_irqrestore(&firesat_list_lock, flags); |
| |
| if (firesat) { |
| packet = iso->first_packet; |
| num = hpsb_iso_n_ready(iso); |
| for (i = 0; i < num; i++, |
| packet = (packet + 1) % iso->buf_packets) { |
| unsigned char *buf = |
| dma_region_i(&iso->data_buf, unsigned char, |
| iso->infos[packet].offset + |
| sizeof(struct CIPHeader)); |
| int count = (iso->infos[packet].len - |
| sizeof(struct CIPHeader)) / |
| (188 + sizeof(struct firewireheader)); |
| if (iso->infos[packet].len <= sizeof(struct CIPHeader)) |
| continue; // ignore empty packet |
| /* printk("%s: Handling packets (%d): ", __func__, */ |
| /* iso->infos[packet].len); */ |
| /* for (j = 0; j < iso->infos[packet].len - */ |
| /* sizeof(struct CIPHeader); j++) */ |
| /* printk("%02X,", buf[j]); */ |
| /* printk("\n"); */ |
| while (count --) { |
| if (buf[sizeof(struct firewireheader)] == 0x47) |
| dvb_dmx_swfilter_packets(&firesat->demux, |
| &buf[sizeof(struct firewireheader)], 1); |
| else |
| printk("%s: invalid packet, skipping\n", __func__); |
| buf += 188 + sizeof(struct firewireheader); |
| |
| } |
| |
| } |
| hpsb_iso_recv_release_packets(iso, num); |
| } |
| else { |
| printk("%s: packets for unknown iso channel, skipping\n", |
| __func__); |
| hpsb_iso_recv_release_packets(iso, hpsb_iso_n_ready(iso)); |
| } |
| } |
| |