Ticket #1184: 6200ch.c.diff

contrib/channel_changers/6200ch.c

@@ -55 +55 @@
         AVC1394_6200_OPERAND_SET
 
 #define STARTING_NODE 1  /* skip 1394 nodes to avoid error msgs */
+#define STARTING_PORT 0
 
 void usage()
 {
-   fprintf(stderr, "Usage: 6200ch [-v] [-n NODE] <channel_num>\n");
+   fprintf(stderr, "Usage: 6200ch [-v] [-n NODE] [-p PORT] [-o] <channel_num>\n");
    fprintf(stderr, "-v        Print additional verbose output\n");
    fprintf(stderr, "-n NODE   node to start device scanning on\n");
+   fprintf(stderr, "-p PORT   port/adapter to use (default:0)\n");
+   fprintf(stderr, "-o        use old method to change channels\n");
    exit(1);
 }
 
@@ -70 +73 @@
    int device = -1;
    int i;
    int verbose = 0;
+   int old = 0;
    quadlet_t cmd[2];
    int dig[3];
    int chn = 550;
 
    /* some people experience crashes when starting on node 1 */
    int starting_node = STARTING_NODE;
+   int starting_port = STARTING_PORT;
    int c;
    int index;
 
@@ -83 +88 @@
       usage();
 
    opterr = 0;
-   while ((c = getopt(argc, argv, "vn:")) != -1) {
+   while ((c = getopt(argc, argv, "vn:p:o")) != -1) {
        switch (c) {
        case 'v':
            verbose = 1;
@@ -91 +96 @@
        case 'n':
            starting_node = atoi(optarg);
            break;
+       case 'o':
+           old = 1;
+           break;
+       case 'p':
+           starting_port = atoi(optarg);
+           break;
        default:
            fprintf(stderr, "incorrect command line arguments\n");
            usage();
@@ -120 +131 @@
       exit(1);
    } 
 
-   if (raw1394_set_port(handle, 0) < 0) {
+   if (raw1394_set_port(handle, starting_port) < 0) {
       perror("couldn't set port");
       raw1394_destroy_handle(handle);
       exit(1);
@@ -169 +180 @@
         exit(1);
    }
 
-   dig[2] = (chn % 10);
-   dig[1] = (chn % 100)  / 10;
-   dig[0] = (chn % 1000) / 100;
+   if (old) {
+       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]);
+       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;
+       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
+           avc1394_transaction_block(handle, device, cmd, 2, 1);
+           usleep(500000);  // small delay for button to register
+       }
    }
 
+   else {
+       cmd[0] = CTL_CMD0 | 0x67;
+       cmd[1] = (0x04 << 24) | (chn << 8) | 0x000000FF;
+       cmd[2] = 0xFF << 24;
+
+       if (verbose)
+           printf("AV/C command for channel %d = 0x%08X %08X %08X\n", 
+                  chn, cmd[0], cmd[1], cmd[2]);
+ 
+       avc1394_transaction_block(handle, device, cmd, 3, 1);
+   }
+
    raw1394_destroy_handle(handle);
    exit(0);
 }