firewiredevice.cpp

Go to the documentation of this file.

 
// C++ headers
#include <algorithm>
#include <chrono> // for milliseconds
#include <thread> // for sleep_for
 
// Qt headers
#include <QMap>
 
// MythTV headers
#include "libmythbase/mythlogging.h"
 
#include "linuxfirewiredevice.h"
#ifdef USING_OSX_FIREWIRE
#include "darwinfirewiredevice.h"
#endif
#include "mpeg/mpegtables.h"
 
#define LOC      QString("FireDev(%1): ").arg(guid_to_string(m_guid))
 
static void fw_init(QMap<uint64_t,QString> &id_to_model);
 
QMap<uint64_t,QString> FirewireDevice::s_idToModel;
QMutex                 FirewireDevice::s_staticLock;
 
FirewireDevice::FirewireDevice(uint64_t guid, uint subunitid, uint speed) :
    m_guid(guid),           m_subunitid(subunitid),
    m_speed(speed)
{
}
 
void FirewireDevice::AddListener(TSDataListener *listener)
{
    if (listener)
    {
        auto it = find(m_listeners.begin(), m_listeners.end(), listener);
        if (it == m_listeners.end())
            m_listeners.push_back(listener);
    }
 
    LOG(VB_RECORD, LOG_INFO, LOC +
        QString("AddListener() %1").arg(m_listeners.size()));
}
 
void FirewireDevice::RemoveListener(TSDataListener *listener)
{
    auto it = m_listeners.end();
 
    do
    {
        it = find(m_listeners.begin(), m_listeners.end(), listener);
        if (it != m_listeners.end())
            it = m_listeners.erase(it);
    }
    while (it != m_listeners.end());
 
    LOG(VB_RECORD, LOG_INFO, LOC +
        QString("RemoveListener() %1").arg(m_listeners.size()));
}
 
bool FirewireDevice::SetPowerState(bool on)
{
    QMutexLocker locker(&m_lock);
 
    std::vector<uint8_t> cmd;
    std::vector<uint8_t> ret;
 
    cmd.push_back(kAVCControlCommand);
    cmd.push_back(kAVCSubunitTypeUnit | kAVCSubunitIdIgnore);
    cmd.push_back(kAVCUnitPowerOpcode);
    cmd.push_back((on) ? kAVCPowerStateOn : kAVCPowerStateOff);
 
    QString cmdStr = (on) ? "on" : "off";
    LOG(VB_RECORD, LOG_INFO, LOC + QString("Powering %1").arg(cmdStr));
 
    if (!SendAVCCommand(cmd, ret, -1))
    {
        LOG(VB_GENERAL, LOG_ERR, LOC + "Power on cmd failed (no response)");
        return false;
    }
 
    if (kAVCAcceptedStatus != ret[0])
    {
        LOG(VB_GENERAL, LOG_ERR, LOC + QString("Power %1 failed").arg(cmdStr));
 
        return false;
    }
 
    LOG(VB_RECORD, LOG_INFO, LOC +
        QString("Power %1 cmd sent successfully").arg(cmdStr));
 
    return true;
}
 
FirewireDevice::PowerState FirewireDevice::GetPowerState(void)
{
    QMutexLocker locker(&m_lock);
 
    std::vector<uint8_t> cmd;
    std::vector<uint8_t> ret;
 
    cmd.push_back(kAVCStatusInquiryCommand);
    cmd.push_back(kAVCSubunitTypeUnit | kAVCSubunitIdIgnore);
    cmd.push_back(kAVCUnitPowerOpcode);
    cmd.push_back(kAVCPowerStateQuery);
 
    LOG(VB_CHANNEL, LOG_INFO, LOC + "Requesting STB Power State");
 
    if (!SendAVCCommand(cmd, ret, -1))
    {
        LOG(VB_GENERAL, LOG_ERR, LOC + "Power cmd failed (no response)");
        return kAVCPowerQueryFailed;
    }
 
    QString loc = LOC + "STB Power State: ";
 
    if (ret[0] != kAVCResponseImplemented)
    {
        LOG(VB_CHANNEL, LOG_INFO, loc + "Query not implemented");
        return kAVCPowerUnknown;
    }
 
    // check 1st operand..
    if (ret[3] == kAVCPowerStateOn)
    {
        LOG(VB_CHANNEL, LOG_INFO, loc + "On");
        return kAVCPowerOn;
    }
 
    if (ret[3] == kAVCPowerStateOff)
    {
        LOG(VB_CHANNEL, LOG_INFO, loc + "Off");
        return kAVCPowerOff;
    }
 
    LOG(VB_GENERAL, LOG_ERR, LOC + "STB Power State: Unknown Response");
 
    return kAVCPowerUnknown;
}
 
bool FirewireDevice::SetChannel(const QString &panel_model,
                                uint alt_method, uint channel)
{
    LOG(VB_CHANNEL, LOG_INFO, QString("SetChannel(model %1, alt %2, chan %3)")
            .arg(panel_model).arg(alt_method).arg(channel));
 
    QMutexLocker locker(&m_lock);
    LOG(VB_CHANNEL, LOG_INFO, "SetChannel() -- locked");
 
    if (!IsSTBSupported(panel_model))
    {
        LOG(VB_GENERAL, LOG_ERR, LOC +
            QString("Model: '%1' ").arg(panel_model) +
            "is not supported by internal channel changer.");
        return false;
    }
 
    std::array<uint,3> digit {
        (channel % 1000) / 100,
        (channel % 100)  / 10,
        (channel % 10)
    };
 
    if (m_subunitid >= kAVCSubunitIdExtended)
    {
        LOG(VB_GENERAL, LOG_ERR, LOC +
            "SetChannel: Extended subunits are not supported.");
 
        return false;
    }
 
    std::vector<uint8_t> cmd;
    std::vector<uint8_t> ret;
 
    if ((panel_model.toUpper() == "SA GENERIC") ||
        (panel_model.toUpper() == "SA4200HD") ||
        (panel_model.toUpper() == "SA4250HDC"))
    {
        if (panel_model.toUpper() == "SA4250HDC")
        {
            LOG(VB_GENERAL, LOG_ERR, LOC +
                "The Scientific Atlanta 4250 HDC is not supported "
                "\n\t\t\tby any MythTV Firewire channel changer."
                "At the moment you must use an IR blaster.");
        }
 
        cmd.push_back(kAVCControlCommand);
        cmd.push_back(kAVCSubunitTypePanel | m_subunitid);
        cmd.push_back(kAVCPanelPassThrough);
        cmd.push_back(kAVCPanelKeyTuneFunction | kAVCPanelKeyPress);
 
        cmd.push_back(4); // operand length
        cmd.push_back((channel>>8) & 0x0f);
        cmd.push_back(channel & 0xff);
        cmd.push_back(0x00);
        cmd.push_back(0x00);
 
        if (!SendAVCCommand(cmd, ret, -1))
            return false;
 
        bool press_ok = (kAVCAcceptedStatus == ret[0]);
 
        cmd[3]= kAVCPanelKeyTuneFunction | kAVCPanelKeyRelease;
        if (!SendAVCCommand(cmd, ret, -1))
            return false;
 
        bool release_ok = (kAVCAcceptedStatus == ret[0]);
 
        if (!press_ok && !release_ok)
        {
            LOG(VB_GENERAL, LOG_ERR, LOC + "Tuning failed");
            return false;
        }
 
        SetLastChannel(channel);
        return true;
    }
 
    // the PACE is obviously not a Motorola channel changer, but the
    // same commands work for it as the Motorola.
    bool is_mot = ((panel_model.startsWith("DCT-", Qt::CaseInsensitive)) ||
                   (panel_model.startsWith("DCH-", Qt::CaseInsensitive)) ||
                   (panel_model.startsWith("DCX-", Qt::CaseInsensitive)) ||
                   (panel_model.startsWith("QIP-", Qt::CaseInsensitive)) ||
                   (panel_model.startsWith("MOTO", Qt::CaseInsensitive)) ||
                   (panel_model.startsWith("PACE-", Qt::CaseInsensitive)));
 
    if (is_mot && !alt_method)
    {
        for (uint d : digit)
        {
            cmd.clear();
            cmd.push_back(kAVCControlCommand);
            cmd.push_back(kAVCSubunitTypePanel | m_subunitid);
            cmd.push_back(kAVCPanelPassThrough);
            cmd.push_back((kAVCPanelKey0 + d) | kAVCPanelKeyPress);
            cmd.push_back(0x00);
            cmd.push_back(0x00);
            cmd.push_back(0x00);
            cmd.push_back(0x00);
 
            if (!SendAVCCommand(cmd, ret, -1))
                return false;
 
            std::this_thread::sleep_for(500ms);
        }
 
        SetLastChannel(channel);
        return true;
    }
 
    if (is_mot && alt_method)
    {
        cmd.push_back(kAVCControlCommand);
        cmd.push_back(kAVCSubunitTypePanel | m_subunitid);
        cmd.push_back(kAVCPanelPassThrough);
        cmd.push_back(kAVCPanelKeyTuneFunction | kAVCPanelKeyPress);
 
        cmd.push_back(4); // operand length
        cmd.push_back((channel>>8) & 0x0f);
        cmd.push_back(channel & 0xff);
        cmd.push_back(0x00);
        cmd.push_back(0xff);
 
        if (!SendAVCCommand(cmd, ret, -1))
            return false;
 
        SetLastChannel(channel);
        return true;
    }
 
    if (panel_model.toUpper() == "SA3250HD")
    {
        cmd.push_back(kAVCControlCommand);
        cmd.push_back(kAVCSubunitTypePanel | m_subunitid);
        cmd.push_back(kAVCPanelPassThrough);
        cmd.push_back(kAVCPanelKeyTuneFunction | kAVCPanelKeyRelease);
 
        cmd.push_back(4); // operand length
        cmd.push_back(0x30 | digit[2]);
        cmd.push_back(0x30 | digit[1]);
        cmd.push_back(0x30 | digit[0]);
        cmd.push_back(0xff);
 
        if (!SendAVCCommand(cmd, ret, -1))
            return false;
 
        cmd[5] = 0x30 | digit[0];
        cmd[6] = 0x30 | digit[1];
        cmd[7] = 0x30 | digit[2];
 
        if (!SendAVCCommand(cmd, ret, -1))
            return false;
 
        SetLastChannel(channel);
        return true;
    }
 
    return false;
}
 
void FirewireDevice::BroadcastToListeners(
    const unsigned char *data, uint dataSize)
{
    if ((dataSize >= TSPacket::kSize) && (data[0] == SYNC_BYTE) &&
        ((data[1] & 0x1f) == 0) && (data[2] == 0))
    {
        ProcessPATPacket(*(reinterpret_cast<const TSPacket*>(data)));
    }
 
    for (auto & listener : m_listeners)
        listener->AddData(data, dataSize);
}
 
void FirewireDevice::SetLastChannel(const uint channel)
{
    m_bufferCleared = (channel == m_lastChannel);
    m_lastChannel   = channel;
 
    LOG(VB_GENERAL, LOG_INFO, QString("SetLastChannel(%1): cleared: %2")
            .arg(channel).arg(m_bufferCleared ? "yes" : "no"));
}
 
void FirewireDevice::ProcessPATPacket(const TSPacket &tspacket)
{
    if (!tspacket.TransportError() && !tspacket.Scrambled() &&
        tspacket.HasPayload() && tspacket.PayloadStart() && (tspacket.PID() == 0))
    {
        PSIPTable pes(tspacket);
        uint crc = pes.CalcCRC();
        m_bufferCleared |= (crc != m_lastCrc);
        m_lastCrc = crc;
#if 0
        LOG(VB_RECORD, LOG_DEBUG, LOC +
            QString("ProcessPATPacket: CRC 0x%1 cleared: %2")
                .arg(crc,0,16).arg(m_bufferCleared ? "yes" : "no"));
#endif
    }
    else
    {
        LOG(VB_GENERAL, LOG_ERR, LOC + "Can't handle large PAT's");
    }
}
 
QString FirewireDevice::GetModelName(uint vendor_id, uint model_id)
{
    QMutexLocker locker(&s_staticLock);
    if (s_idToModel.empty())
        fw_init(s_idToModel);
 
    QString ret = s_idToModel[(((uint64_t) vendor_id) << 32) | model_id];
 
    if (ret.isEmpty())
        return "MOTO GENERIC";
    return ret;
}
 
std::vector<AVCInfo> FirewireDevice::GetSTBList(void)
{
    std::vector<AVCInfo> list;
 
#ifdef USING_LINUX_FIREWIRE
    list = LinuxFirewireDevice::GetSTBList();
#elif defined(USING_OSX_FIREWIRE)
    list = DarwinFirewireDevice::GetSTBList();
#endif
 
//#define DEBUG_AVC_INFO
#ifdef DEBUG_AVC_INFO
    AVCInfo info;
    info.guid     = 0x0016928a7b600001ULL;
    info.specid   = 0x0;
    info.vendorid = 0x000014f8;
    info.modelid  = 0x00001072;
    info.firmware_revision = 0x0;
    info.product_name = "Explorer 4200 HD";
    list.push_back(info);
 
    info.guid     = 0xff2145a850e39810ULL;
    info.specid   = 0x0;
    info.vendorid = 0x000014f8;
    info.modelid  = 0x00000be0;
    info.firmware_revision = 0x0;
    info.product_name = "Explorer 3250 HD";
    list.push_back(info);
#endif // DEBUG_AVC_INFO
 
    return list;
}
 
static void fw_init(QMap<uint64_t,QString> &id_to_model)
{
    const std::array<const uint64_t,16> sa_vendor_ids
    {
        0x0a73,    0x0f21,    0x11e6,    0x14f8,    0x1692,    0x1868,
        0x1947,    0x1ac3,    0x1bd7,    0x1cea,    0x1e6b,    0x21be,
        0x223a,    0x22ce,    0x23be,    0x252e,
    };
 
    for (uint64_t vendor_id : sa_vendor_ids)
    {
        id_to_model[vendor_id << 32 | 0x0be0] = "SA3250HD";
        id_to_model[vendor_id << 32 | 0x1072] = "SA4200HD";
        id_to_model[vendor_id << 32 | 0x10cc] = "SA4250HDC";
        id_to_model[vendor_id << 32 | 0x22ce] = "SA8300HD";
    }
 
    const std::array<uint64_t,59> motorola_vendor_ids
    {
        /* DCH-3200, DCX-3200 */
        0x1c11,    0x1cfb,    0x1fc4,    0x23a3,    0x23ee,    0x25f1,
        0xfa01,    0x25f1,    0x25f2,  0xcc7d37,  0x946269,  0x6455b1,
        /* DCX-3432 */
        0x24a0,
        /* DCH-3416 */
        0x1e46,
        /* DCT-3416 */
        0x1bdd,
        /* DCT-3412 */
        0x159a,
        /* DCT-6200, DCT-3416 */
        0x0ce5,    0x0e5c,    0x1225,    0x0f9f,    0x1180,
        0x12c9,    0x11ae,    0x152f,    0x14e8,    0x16b5,    0x1371,
        0x19a6,    0x1aad,    0x0b06,    0x195e,    0x10dc,
        /* DCT-6212 */
        0x0f9f,    0x152f,
        /* DCT-6216, 2224 */
        0x17ee,    0x1a66,
        /* QIP 6200 */
        0x211e,
        /* QIP 7100 */
        0x2374,
        /* unknown, see http://standards.ieee.org/regauth/oui/oui.txt */
        0x04db,    0x0406,    0x0ce5,    0x111a,    0x1225,    0x1404,
        0x1626,    0x18c0,    0x1ade,    0x1cfb,    0x2040,    0x2180,
        0x2210,    0x230b,    0x2375,    0x2395,    0x23a2,    0x23ed,
        0x23ee,    0x23a0,    0x23a1,
    };
 
    for (uint64_t vendor_id : motorola_vendor_ids)
    {
        id_to_model[vendor_id << 32 | 0xf740] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0xf804] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0xfa03] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0xfa05] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0xfa07] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0x24a1] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0x2322] = "DCX-3200";
        id_to_model[vendor_id << 32 | 0xea05] = "DCX-3432";
        id_to_model[vendor_id << 32 | 0xd330] = "DCH-3200";
        id_to_model[vendor_id << 32 | 0xb630] = "DCH-3416";
        id_to_model[vendor_id << 32 | 0x34cb] = "DCT-3412";
        id_to_model[vendor_id << 32 | 0x346b] = "DCT-3416";
        id_to_model[vendor_id << 32 | 0xb630] = "DCT-3416";
        id_to_model[vendor_id << 32 | 0x6200] = "DCT-6200";
        id_to_model[vendor_id << 32 | 0x620a] = "DCT-6200";
        id_to_model[vendor_id << 32 | 0x64ca] = "DCT-6212";
        id_to_model[vendor_id << 32 | 0x64cb] = "DCT-6212";
        id_to_model[vendor_id << 32 | 0x646b] = "DCT-6216";
        id_to_model[vendor_id << 32 | 0x8100] = "QIP-7100";
        id_to_model[vendor_id << 32 | 0x7100] = "QIP-6200";
        id_to_model[vendor_id << 32 | 0x0001] = "QIP-7100";
    }
 
    const std::array<const uint64_t,2> pace_vendor_ids
    {
        /* PACE 550-HD & 779 */
        0x1cc3, 0x5094,
    };
 
    for (uint64_t vendor_id : pace_vendor_ids)
    {
        id_to_model[vendor_id << 32 | 0x10551] = "PACE-550";
        id_to_model[vendor_id << 32 | 0x10755] = "PACE-779";
    }
}
 
bool FirewireDevice::IsSTBSupported(const QString &panel_model)
{
    QString model = panel_model.toUpper();
    return ((model == "DCH-3200") ||
            (model == "DCH-3416") ||
            (model == "DCT-3412") ||
            (model == "DCT-3416") ||
            (model == "DCT-6200") ||
            (model == "DCT-6212") ||
            (model == "DCT-6216") ||
            (model == "DCX-3200") ||
            (model == "SA3250HD") ||
            (model == "SA4200HD") ||
            (model == "SA4250HDC") ||
            (model == "SA8300HD") ||
            (model == "PACE-550") ||
            (model == "PACE-779") ||
            (model == "QIP-6200") ||
            (model == "QIP-7100") ||
            (model == "SA GENERIC") ||
            (model == "MOTO GENERIC"));
}