remove some debug, fix abs -> llabs
[enigma2.git] / lib / dvb / tstools.cpp
index 4dab529..fa65a6d 100644 (file)
@@ -1,3 +1,4 @@
+#define _ISOC99_SOURCE /* for llabs */
 #include <lib/dvb/tstools.h>
 #include <lib/base/eerror.h>
 #include <unistd.h>
@@ -15,6 +16,10 @@ eDVBTSTools::eDVBTSTools()
        
        m_use_streaminfo = 0;
        m_samples_taken = 0;
+       
+       m_last_filelength = 0;
+       
+       m_futile = 0;
 }
 
 eDVBTSTools::~eDVBTSTools()
@@ -22,23 +27,24 @@ eDVBTSTools::~eDVBTSTools()
        closeFile();
 }
 
-int eDVBTSTools::openFile(const char *filename)
+int eDVBTSTools::openFile(const char *filename, int nostreaminfo)
 {
        closeFile();
        
-       m_streaminfo.load((std::string(filename) + ".ap").c_str());
+       if (!nostreaminfo)
+               m_streaminfo.load((std::string(filename) + ".ap").c_str());
        
        if (!m_streaminfo.empty())
                m_use_streaminfo = 1;
        else
        {
-               eDebug("no recorded stream information available");
+//             eDebug("no recorded stream information available");
                m_use_streaminfo = 0;
        }
        
        m_samples_taken = 0;
 
-       if (m_file.open(filename) < 0)
+       if (m_file.open(filename, 1) < 0)
                return -1;
        return 0;
 }
@@ -70,14 +76,17 @@ int eDVBTSTools::getPTS(off_t &offset, pts_t &pts, int fixed)
        offset -= offset % 188;
        
        if (m_file.lseek(offset, SEEK_SET) < 0)
+       {
+               eDebug("lseek failed");
                return -1;
-
+       }
+       
        int left = m_maxrange;
        
        while (left >= 188)
        {
-               unsigned char block[188];
-               if (m_file.read(block, 188) != 188)
+               unsigned char packet[188];
+               if (m_file.read(packet, 188) != 188)
                {
                        eDebug("read error");
                        break;
@@ -85,12 +94,13 @@ int eDVBTSTools::getPTS(off_t &offset, pts_t &pts, int fixed)
                left -= 188;
                offset += 188;
                
-               if (block[0] != 0x47)
+               if (packet[0] != 0x47)
                {
+                       eDebug("resync");
                        int i = 0;
                        while (i < 188)
                        {
-                               if (block[i] == 0x47)
+                               if (packet[i] == 0x47)
                                        break;
                                ++i;
                        }
@@ -98,10 +108,38 @@ int eDVBTSTools::getPTS(off_t &offset, pts_t &pts, int fixed)
                        continue;
                }
                
-               int pid = ((block[1] << 8) | block[2]) & 0x1FFF;
-               int pusi = !!(block[1] & 0x40);
+               int pid = ((packet[1] << 8) | packet[2]) & 0x1FFF;
+               int pusi = !!(packet[1] & 0x40);
                
 //             printf("PID %04x, PUSI %d\n", pid, pusi);
+
+               unsigned char *payload;
+               
+                       /* check for adaption field */
+               if (packet[3] & 0x20)
+               {
+                       if (packet[4] >= 183)
+                               continue;
+                       if (packet[4])
+                       {
+                               if (packet[5] & 0x10) /* PCR present */
+                               {
+                                       pts  = ((unsigned long long)(packet[ 6]&0xFF)) << 25;
+                                       pts |= ((unsigned long long)(packet[ 7]&0xFF)) << 17;
+                                       pts |= ((unsigned long long)(packet[ 8]&0xFE)) << 9;
+                                       pts |= ((unsigned long long)(packet[ 9]&0xFF)) << 1;
+                                       pts |= ((unsigned long long)(packet[10]&0x80)) >> 7;
+                                       offset -= 188;
+                                       eDebug("PCR  found at %llx: %16llx", offset, pts);
+                                       if (fixed && fixupPTS(offset, pts))
+                                               return -1;
+                                       return 0;
+                               }
+                       }
+                       payload = packet + packet[4] + 4 + 1;
+               } else
+                       payload = packet + 4;
+
                
                if (m_pid >= 0)
                        if (pid != m_pid)
@@ -109,33 +147,31 @@ int eDVBTSTools::getPTS(off_t &offset, pts_t &pts, int fixed)
                if (!pusi)
                        continue;
                
-                       /* ok, now we have a PES header */
-               unsigned char *pes;
-               
-                       /* check for adaption field */
-               if (block[3] & 0x20)
-                       pes = block + block[4] + 4 + 1;
-               else
-                       pes = block + 4;
                
                        /* somehow not a startcode. (this is invalid, since pusi was set.) ignore it. */
-               if (pes[0] || pes[1] || (pes[2] != 1))
+               if (payload[0] || payload[1] || (payload[2] != 1))
                        continue;
                
-               if (pes[7] & 0x80) /* PTS */
+                       /* drop non-audio, non-video packets because other streams
+                          can be non-compliant.*/
+               if (((payload[3] & 0xE0) != 0xC0) &&  // audio
+                   ((payload[3] & 0xF0) != 0xE0))    // video
+                       continue;
+               
+               if (payload[7] & 0x80) /* PTS */
                {
-                       pts  = ((unsigned long long)(pes[ 9]&0xE))  << 29;
-                       pts |= ((unsigned long long)(pes[10]&0xFF)) << 22;
-                       pts |= ((unsigned long long)(pes[11]&0xFE)) << 14;
-                       pts |= ((unsigned long long)(pes[12]&0xFF)) << 7;
-                       pts |= ((unsigned long long)(pes[13]&0xFE)) >> 1;
+                       pts  = ((unsigned long long)(payload[ 9]&0xE))  << 29;
+                       pts |= ((unsigned long long)(payload[10]&0xFF)) << 22;
+                       pts |= ((unsigned long long)(payload[11]&0xFE)) << 14;
+                       pts |= ((unsigned long long)(payload[12]&0xFF)) << 7;
+                       pts |= ((unsigned long long)(payload[13]&0xFE)) >> 1;
                        offset -= 188;
-                       
-//                     eDebug("found pts %08llx at %08llx", pts, offset);
+
+//                     eDebug("found pts %08llx at %08llx pid %02x stream: %02x", pts, offset, pid, payload[3]);
                        
                                /* convert to zero-based */
-                       if (fixed)
-                               fixupPTS(offset, pts);
+                       if (fixed && fixupPTS(offset, pts))
+                                       return -1;
                        return 0;
                }
        }
@@ -181,45 +217,92 @@ int eDVBTSTools::getOffset(off_t &offset, pts_t &pts)
                return 0;
        } else
        {
-//             eDebug("get offset");
+               calcBegin(); calcEnd();
+               
+               if (!m_begin_valid)
+                       return -1;
+               if (!m_end_valid)
+                       return -1;
+
                if (!m_samples_taken)
                        takeSamples();
                
                if (!m_samples.empty())
                {
-//             eDebug("ok, samples ok");
-                               /* search entry before and after */
-                       std::map<pts_t, off_t>::const_iterator l = m_samples.lower_bound(pts);
-                       std::map<pts_t, off_t>::const_iterator u = l;
-
-                       if (l != m_samples.begin())
-                               --l;
-               
-                       if ((u != m_samples.end()) && (l != m_samples.end()))
+                       int maxtries = 5;
+                       pts_t p = -1;
+                       
+                       while (maxtries--)
                        {
+                                       /* search entry before and after */
+                               std::map<pts_t, off_t>::const_iterator l = m_samples.lower_bound(pts);
+                               std::map<pts_t, off_t>::const_iterator u = l;
+
+                               if (l != m_samples.begin())
+                                       --l;
+                               
+                                       /* we could have seeked beyond the end */
+                               if (u == m_samples.end())
+                               {
+                                               /* use last segment for interpolation. */
+                                       if (l != m_samples.begin())
+                                       {
+                                               --u;
+                                               --l;
+                                       }
+                               }
+                                       
+                                       /* if we don't have enough points */
+                               if (u == m_samples.end())
+                                       break;
+                               
                                pts_t pts_diff = u->first - l->first;
                                off_t offset_diff = u->second - l->second;
-//             eDebug("using: %llx:%llx -> %llx:%llx", l->first, u->first, l->second, u->second);
-       
+
+                               eDebug("using: %llx:%llx -> %llx:%llx", l->first, u->first, l->second, u->second);
+
+                               int bitrate;
+                               
                                if (pts_diff)
+                                       bitrate = offset_diff * 90000 * 8 / pts_diff;
+                               else
+                                       bitrate = 0;
+
+                               offset = l->second;
+                               offset += ((pts - l->first) * (pts_t)bitrate) / 8ULL / 90000ULL;
+                               offset -= offset % 188;
+                               
+                               p = pts;
+                               
+                               if (!takeSample(offset, p))
                                {
-                                       int bitrate = offset_diff * 90000 * 8 / pts_diff;
-                                       if (bitrate > 0)
+                                       int diff = (p - pts) / 90;
+                       
+                                       eDebug("calculated diff %d ms", diff);
+                                       if (abs(diff) > 300)
                                        {
-                                               offset = l->second;
-                                               offset += ((pts - l->first) * (pts_t)bitrate) / 8ULL / 90000ULL;
-                                               offset -= offset % 188;
-                                               return 0;
+                                               eDebug("diff to big, refining");
+                                               continue;
                                        }
-                               }
+                               } else
+                                       eDebug("no sample taken, refinement not possible.");
+
+                               break;
+                       }
+                       
+                               /* if even the first sample couldn't be taken, fall back. */
+                               /* otherwise, return most refined result. */
+                       if (p != -1)
+                       {
+                               pts = p;
+                               return 0;
                        }
                }
                
-               eDebug("falling back");
                int bitrate = calcBitrate();
                offset = pts * (pts_t)bitrate / 8ULL / 90000ULL;
                offset -= offset % 188;
-
+               
                return 0;
        }
 }
@@ -240,11 +323,13 @@ void eDVBTSTools::calcBegin()
        if (!m_file.valid())
                return;
 
-       if (!m_begin_valid)
+       if (!(m_begin_valid || m_futile))
        {
                m_offset_begin = 0;
                if (!getPTS(m_offset_begin, m_pts_begin))
                        m_begin_valid = 1;
+               else
+                       m_futile = 1;
        }
 }
 
@@ -255,27 +340,44 @@ void eDVBTSTools::calcEnd()
        
        off_t end = m_file.lseek(0, SEEK_END);
        
-       if (abs(end - m_offset_end) > 1*1024*1024)
+       if (llabs(end - m_last_filelength) > 1*1024*1024)
        {
-               m_offset_end = end;
+               m_last_filelength = end;
                m_end_valid = 0;
-               eDebug("file size changed, recalc length");
+               
+               m_futile = 0;
+//             eDebug("file size changed, recalc length");
        }
        
        int maxiter = 10;
        
-       while (!m_end_valid)
+       m_offset_end = m_last_filelength;
+       
+       while (!(m_end_valid || m_futile))
        {
                if (!--maxiter)
+               {
+                       m_futile = 1;
                        return;
-               
+               }
+
                m_offset_end -= m_maxrange;
                if (m_offset_end < 0)
                        m_offset_end = 0;
+
+                       /* restore offset if getpts fails */
+               off_t off = m_offset_end;
+
                if (!getPTS(m_offset_end, m_pts_end))
                        m_end_valid = 1;
+               else
+                       m_offset_end = off;
+
                if (!m_offset_end)
-                       return;
+               {
+                       m_futile = 1;
+                       break;
+               }
        }
 }
 
@@ -327,24 +429,31 @@ void eDVBTSTools::takeSamples()
        off_t bytes_per_sample = (m_offset_end - m_offset_begin) / (long long)nr_samples;
        if (bytes_per_sample < 40*1024*1024)
                bytes_per_sample = 40*1024*1024;
-       
+
        bytes_per_sample -= bytes_per_sample % 188;
        
        for (off_t offset = m_offset_begin; offset < m_offset_end; offset += bytes_per_sample)
        {
-               off_t o = offset;
                pts_t p;
-               if (!eDVBTSTools::getPTS(o, p, 1))
-               {
-//                     eDebug("sample: %llx, %llx", o, p);
-                       m_samples[p] = o;
-               }
+               takeSample(offset, p);
        }
-       m_samples[m_pts_begin] = m_offset_begin;
-       m_samples[m_pts_end] = m_offset_end;
+       m_samples[0] = m_offset_begin;
+       m_samples[m_pts_end - m_pts_begin] = m_offset_end;
+       
 //     eDebug("begin, end: %llx %llx", m_offset_begin, m_offset_end); 
 }
 
+       /* returns 0 when a sample was taken. */
+int eDVBTSTools::takeSample(off_t off, pts_t &p)
+{
+       if (!eDVBTSTools::getPTS(off, p, 1))
+       {
+               m_samples[p] = off;
+               return 0;
+       }
+       return 1;
+}
+
 int eDVBTSTools::findPMT(int &pmt_pid, int &service_id)
 {
                /* FIXME: this will be factored out soon! */
@@ -364,20 +473,20 @@ int eDVBTSTools::findPMT(int &pmt_pid, int &service_id)
        
        while (left >= 188)
        {
-               unsigned char block[188];
-               if (m_file.read(block, 188) != 188)
+               unsigned char packet[188];
+               if (m_file.read(packet, 188) != 188)
                {
                        eDebug("read error");
                        break;
                }
                left -= 188;
                
-               if (block[0] != 0x47)
+               if (packet[0] != 0x47)
                {
                        int i = 0;
                        while (i < 188)
                        {
-                               if (block[i] == 0x47)
+                               if (packet[i] == 0x47)
                                        break;
                                ++i;
                        }
@@ -385,9 +494,9 @@ int eDVBTSTools::findPMT(int &pmt_pid, int &service_id)
                        continue;
                }
                
-               int pid = ((block[1] << 8) | block[2]) & 0x1FFF;
+               int pid = ((packet[1] << 8) | packet[2]) & 0x1FFF;
                
-               int pusi = !!(block[1] & 0x40);
+               int pusi = !!(packet[1] & 0x40);
                
                if (!pusi)
                        continue;
@@ -396,10 +505,13 @@ int eDVBTSTools::findPMT(int &pmt_pid, int &service_id)
                unsigned char *sec;
                
                        /* check for adaption field */
-               if (block[3] & 0x20)
-                       sec = block + block[4] + 4 + 1;
-               else
-                       sec = block + 4;
+               if (packet[3] & 0x20)
+               {
+                       if (packet[4] >= 183)
+                               continue;
+                       sec = packet + packet[4] + 4 + 1;
+               } else
+                       sec = packet + 4;
                
                if (sec[0])     /* table pointer, assumed to be 0 */
                        continue;