Ticket #235: 6200ch.c

/*
 * 6200ch - an external channel changer for Motorola DCT-6200 Tuner 
 * 
 * Copyright 2004,2005 by Stacey D. Son <mythdev@son.org> 
 * 
 * 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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software Foundation,
 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

#include <libavc1394/rom1394.h>
#include <libavc1394/avc1394.h>
#include <libraw1394/raw1394.h>
#include <sys/types.h>
#include <stdio.h>
#include <errno.h>
#include <stdlib.h>

// Motorola DCT-6200 IDs
// Note: there are too many vendor IDs for the 6200
#define DCT6200_VENDOR_ID1 0x00000ce5
#define DCT6200_VENDOR_ID2 0x00000e5c
#define DCT6200_VENDOR_ID3 0x00001225
#define DCT6200_VENDOR_ID4 0x00000f9f
#define DCT6200_VENDOR_ID5 0x00001180
#define DCT6200_VENDOR_ID6 0x000012c9
#define DCT6412_VENDOR_ID1 0x00000f9f

int vendor_ids[] = { -1,                 // Specified by -V
                    DCT6200_VENDOR_ID1, 
                    DCT6200_VENDOR_ID2, 
                    DCT6200_VENDOR_ID3, 
                    DCT6200_VENDOR_ID4, 
                    DCT6200_VENDOR_ID5, 
                    DCT6200_VENDOR_ID6, 
                    DCT6412_VENDOR_ID1  
                   };
int get_vendor (int vid) {
  int last = sizeof(vendor_ids) / sizeof(int);
  int i;
  for (i = 0; i < last; i++) {
    if (vid == vendor_ids[i])
      return 1;
  }
  return 0;
}


#define DCT6200_MODEL_ID1  0x0000620a
#define DCT6200_MODEL_ID2  0x00006200
#define DCT6412_MODEL_ID1  0x000064ca
#define DCT6208_MODEL_ID1  0x0000628a
int model_ids[] = {-1,                   // Specified by -M 
                   DCT6200_MODEL_ID1,
                   DCT6200_MODEL_ID2,
                   DCT6412_MODEL_ID1
                   //                  ,
                   // DCT6208_MODEL_ID1
                  };

int get_model (int mid) {
  int last = sizeof(model_ids) / sizeof(int);
  int i;
  for (i = 0; i < last; i++) {
    if (mid == model_ids[i])
      return 1;
  }
  return 0;
}

#define DCT6200_SPEC_ID    0x00005068
#define DCT6200_SW_VERSION 0x00010101


#define AVC1394_SUBUNIT_TYPE_6200 (9 << 19)  /* uses a reserved subunit type */ 

#define AVC1394_6200_COMMAND_CHANNEL 0x000007C00   /* 6200 subunit command */
#define AVC1394_6200_OPERAND_SET 0x20      /* 6200 subunit command operand */

#define CTL_CMD0 AVC1394_CTYPE_CONTROL | AVC1394_SUBUNIT_TYPE_6200 | \
        AVC1394_SUBUNIT_ID_0 | AVC1394_6200_COMMAND_CHANNEL | \
        AVC1394_6200_OPERAND_SET


void usage()
{
   fprintf(stderr, "Usage: 6200ch [-v] [-p n] <channel_num>\n");
   exit(1);
}

int main (int argc, char *argv[])
{
   rom1394_directory dir;
   int device = -1;
   int i;
   int verbose = 0;
   int port = 0;
   quadlet_t cmd[2];
   int dig[3];
   int chn = 0;

   if (argc < 2) 
      usage();

   argc--;
   argv++;

   while (argc > 0) {
     if (argv[0][0] == '-' && argv[0][1] == 'h') {
       usage();
     }
     if (argv[0][0] == '-' && argv[0][1] == 'v') {
       verbose = 1;
       argc--;
       argv++;
       continue;;
     }
     if (argv[0][0] == '-' && argv[0][1] == 'p') {
       argc--;
       argv++;
       if (argc > 0) {
         port = atoi (argv[0]);
         argc--;
         argv++;
       }
       continue;
     }
     if (argv[0][0] == '-' && argv[0][1] == 'V') {
       argc--;
       argv++;
       if (argc > 0) {
         sscanf (argv[0], "%i", &vendor_ids[0]);
         argc--;
         argv++;
       }
       continue;
     }
     if (argv[0][0] == '-' && argv[0][1] == 'M') {
       argc--;
       argv++;
       if (argc > 0) {
         sscanf (argv[0], "%i", &model_ids[0]);
         argc--;
         argv++;
       }
       continue;
     }
     if (argc == 1) {
       chn = atoi(argv[0]);
         argc--;
         argv++;
     }
     else
       usage();
   }


#ifdef RAW1394_V_0_8
   raw1394handle_t handle = raw1394_get_handle();
#else
   raw1394handle_t handle = raw1394_new_handle();
#endif

   if (!handle) {
      if (!errno) {
         fprintf(stderr, "Not Compatable!\n");
      } else {
         perror("Couldn't get 1394 handle");
         fprintf(stderr, "Is ieee1394, driver, and raw1394 loaded?\n");
      }
      exit(1);
   } 

   if (raw1394_set_port(handle, port) < 0) {
      perror("Couldn't set port.\n");
      raw1394_destroy_handle(handle);
      exit(1);
   }

   int nc = raw1394_get_nodecount(handle);
   if (verbose) 
       printf ("%d nodes found.\n\n", nc);

   for (i = nc - 1; i >= 0; i--) {
      if (rom1394_get_directory(handle, i, &dir) < 0) {
          if (verbose) fprintf(stderr,
                        "error reading config rom directory for node %d\n", i);
      }

     if (verbose) 
         printf("node %d: vendor_id = 0x%08x model_id = 0x%08x\n\n",
                i, dir.vendor_id, dir.model_id); 
                
     if ( get_vendor (dir.vendor_id)  &&
          get_model (dir.model_id)   )  {

         if (dir.unit_spec_id != DCT6200_SPEC_ID)
           fprintf(stderr, "Warning: Unit Spec ID different: 0x%08x\n",
                   dir.unit_spec_id);
         if (dir.unit_sw_version != DCT6200_SW_VERSION)
           fprintf(stderr, "Warning: Unit Software Version different: 0x%08x\n",
                   dir.unit_sw_version);
         device = i;
         break;
     }
   }
    
   if (device == -1) {
        fprintf(stderr,
                "\nCould not find Motorola DCT-6200 on the 1394 bus.\n"
                " Run with \"-v\".  Then run with \"-V vendor_id -M model_id\""
                ".\n--OR--\n"
                " Run plugreport,then retry /w \"-p {Host Adapter #}\"\n\n");
        raw1394_destroy_handle(handle);
        exit(1);
   }

   if (chn > 0) {
       if (verbose) printf("Changing to channel %d\n", chn);

       dig[2] = (chn % 10);
       dig[1] = (chn % 100)  / 10;
       dig[0] = (chn % 1000) / 100;

       if (verbose)
          printf("AV/C Command: %d%d%d = Op1=0x%08X Op2=0x%08X Op3=0x%08X\n", 
                dig[0], dig[1], dig[2], 
                CTL_CMD0 | dig[0], CTL_CMD0 | dig[1], CTL_CMD0 | dig[2]);

       for (i=0; i<3; i++) {
          cmd[0] = CTL_CMD0 | dig[i];
          cmd[1] = 0x0;

          avc1394_transaction_block(handle, device, cmd, 2, 1);
          usleep(500000);  // small delay for button to register
       }
   }
   raw1394_destroy_handle(handle);
   exit(0);
}