vmcmd.c

基于linux的DVD播放器程序

/* Ogle - A video player
 * Copyright (C) 2000, 2001 Martin Norb鋍k, H錵an Hjort
 *
 * 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 <stdio.h>
#include <ctype.h>
#include <inttypes.h>

#include "vmcmd.h"


// freebsd compatibility
#ifndef PRIu8
#define PRIu8 "d"
#endif

// freebsd compatibility
#ifndef PRIu16
#define PRIu16 "d"
#endif


typedef struct
{
  uint8_t bits[8];
  uint8_t examined[8];
} cmd_t;


static const char *cmp_op_table[] = {
  NULL, "&", "==", "!=", ">=", ">", "<=", "<"
};
static const char *set_op_table[] = {
  NULL, "=", "<->", "+=", "-=", "*=", "/=", "%=", "rnd", "&=", "|=", "^="
};

static const char *link_table[] = {
  "LinkNoLink",  "LinkTopC",    "LinkNextC",   "LinkPrevC",
  NULL,          "LinkTopPG",   "LinkNextPG",  "LinkPrevPG",
  NULL,          "LinkTopPGC",  "LinkNextPGC", "LinkPrevPGC",
  "LinkGoUpPGC", "LinkTailPGC", NULL,          NULL,
  "RSM"
};

static const char *system_reg_table[] = {
  "Menu Description Language Code",
  "Audio Stream Number",
  "Sub-picture Stream Number",
  "Angle Number",
  "Title Track Number",
  "VTS Title Track Number",
  "VTS PGC Number",
  "PTT Number for One_Sequential_PGC_Title",
  "Highlighted Button Number",
  "Navigation Timer",
  "Title PGC Number for Navigation Timer",
  "Audio Mixing Mode for Karaoke",
  "Country Code for Parental Management",
  "Parental Level",
  "Player Configurations for Video",
  "Player Configurations for Audio",
  "Initial Language Code for Audio",
  "Initial Language Code Extension for Audio",
  "Initial Language Code for Sub-picture",
  "Initial Language Code Extension for Sub-picture",
  "Player Regional Code",
  "Reserved 21",
  "Reserved 22",
  "Reserved 23"
};

static const char *system_reg_abbr_table[] = {
  NULL,
  "ASTN",
  "SPSTN",
  "AGLN",
  "TTN",
  "VTS_TTN",
  "TT_PGCN",
  "PTTN",
  "HL_BTNN",
  "NVTMR",
  "NV_PGCN",
  NULL,
  "CC_PLT",
  "PLT",
  NULL,
  NULL,
  NULL,
  NULL,
  NULL,
  NULL,
  NULL,
  NULL,
  NULL,
  NULL,
};
    


static uint32_t bits(cmd_t *cmd, int byte, int bit, int count) {
  uint32_t val = 0;
  int bit_mask;
  
  while(count--) {
    if(bit > 7) {
      bit = 0;
      byte++;
    }
    bit_mask = 0x01 << (7-bit);
    val <<= 1;
    if((cmd->bits[byte]) & bit_mask)
      val |= 1;
    cmd->examined[byte] |= bit_mask;
    bit++;
  }
  return val;
}


static void print_system_reg(uint16_t reg) {
  if(reg < sizeof(system_reg_abbr_table) / sizeof(char *))
    fprintf(stderr, system_reg_table[reg]);
  else
    fprintf(stderr, " WARNING: Unknown system register ");
}

static void print_reg(uint8_t reg) {
  if(reg & 0x80)
    print_system_reg(reg & 0x7f);
  else
    if(reg < 16)
      fprintf(stderr, "g[%" PRIu8 "]", reg);
    else
      fprintf(stderr, " WARNING: Unknown general register ");
}

static void print_cmp_op(uint8_t op) {
  if(op < sizeof(cmp_op_table) / sizeof(char *) && cmp_op_table[op] != NULL)
    fprintf(stderr, " %s ", cmp_op_table[op]);
  else
    fprintf(stderr, " WARNING: Unknown compare op ");
}

static void print_set_op(uint8_t op) {
  if(op < sizeof(set_op_table) / sizeof(char *) && set_op_table[op] != NULL)
    fprintf(stderr, " %s ", set_op_table[op]);
  else
    fprintf(stderr, " WARNING: Unknown set op ");
}

static void print_reg_or_data(cmd_t *cmd, int immediate, int byte) {
  if(immediate) {
    int i = bits(cmd,byte,0,16);
    
    fprintf(stderr, "0x%x", i);
    if(isprint(i & 0xff) && isprint((i>>8) & 0xff))
      fprintf(stderr, " (\"%c%c\")", (char)((i>>8) & 0xff), (char)(i & 0xff));
  } else {
    print_reg(bits(cmd,byte + 1,0,8));
  }
}

static void print_reg_or_data_2(cmd_t *cmd, int immediate, int byte) {
  if(immediate)
    fprintf(stderr, "0x%x", bits(cmd,byte,1,7));
  else
    fprintf(stderr, "g[%" PRIu8 "]", bits(cmd,byte,4,4));
}

static void print_if_version_1(cmd_t *cmd) {
  uint8_t op = bits(cmd,1,1,3);
  
  if(op) {
    fprintf(stderr, "if (");
    print_reg(bits(cmd,3,0,8));
    print_cmp_op(op);
    print_reg_or_data(cmd,bits(cmd,1,0,1), 4);
    fprintf(stderr, ") ");
  }
}

static void print_if_version_2(cmd_t *cmd) {
  uint8_t op = bits(cmd,1,1,3);
  
  if(op) {
    fprintf(stderr, "if (");
    print_reg(bits(cmd,6,0,8));
    print_cmp_op(op);
    print_reg(bits(cmd,7,0,8));
    fprintf(stderr, ") ");
  }
}

static void print_if_version_3(cmd_t *cmd) {
  uint8_t op = bits(cmd,1,1,3);
  
  if(op) {
    fprintf(stderr, "if (");
    print_reg(bits(cmd,2,0,8));
    print_cmp_op(op);
    print_reg_or_data(cmd,bits(cmd,1,0,1), 6);
    fprintf(stderr, ") ");
  }
}

static void print_if_version_4(cmd_t *cmd) {
  uint8_t op = bits(cmd,1,1,3);
  
  if(op) {
    fprintf(stderr, "if (");
    print_reg(bits(cmd,1,4,4));
    print_cmp_op(op);
    print_reg_or_data(cmd,bits(cmd,1,0,1), 4);
    fprintf(stderr, ") ");
  }
}

static void print_if_version_5(cmd_t *cmd) {
  uint8_t op = bits(cmd,1,1,3);
  
  if(op) {
    fprintf(stderr, "if (");
    print_reg(bits(cmd,4,0,8));
    print_cmp_op(op);
    print_reg(bits(cmd,5,0,8));
    fprintf(stderr, ") ");
  }
}

static void print_special_instruction(cmd_t *cmd) {
  uint8_t op = bits(cmd,1,4,4);
  
  switch(op) {
    case 0: // NOP
      fprintf(stderr, "Nop");
      break;
    case 1: // Goto line
      fprintf(stderr, "Goto %" PRIu8, bits(cmd,7,0,8));
      break;
    case 2: // Break
      fprintf(stderr, "Break");
      break;
    case 3: // Parental level
      fprintf(stderr, "SetTmpPML %" PRIu8 ", Goto %" PRIu8, 
	      bits(cmd,6,4,4), bits(cmd,7,0,8));
      break;
    default:
      fprintf(stderr, "WARNING: Unknown special instruction (%i)", 
	      bits(cmd,1,4,4));
  }
}

static void print_linksub_instruction(cmd_t *cmd) {
  int linkop = bits(cmd,7,3,5);
  int button = bits(cmd,6,0,6);
  
  if(linkop < sizeof(link_table)/sizeof(char *) && link_table[linkop] != NULL)
    fprintf(stderr, "%s (button %" PRIu8 ")", link_table[linkop], button);
  else
    fprintf(stderr, "WARNING: Unknown linksub instruction (%i)", linkop);
}

static void print_link_instruction(cmd_t *cmd, int optional) {
  uint8_t op = bits(cmd,1,4,4);
  
  if(optional && op)
    fprintf(stderr, ", ");
  
  switch(op) {
    case 0:
      if(!optional)
      fprintf(stderr, "WARNING: NOP (link)!");
      break;
    case 1:
      print_linksub_instruction(cmd);
      break;
    case 4:
      fprintf(stderr, "LinkPGCN %" PRIu16, bits(cmd,6,1,15));
      break;
    case 5:
      fprintf(stderr, "LinkPTT %" PRIu16 " (button %" PRIu8 ")", 
	      bits(cmd,6,6,10), bits(cmd,6,0,6));
      break;
    case 6:
      fprintf(stderr, "LinkPGN %" PRIu8 " (button %" PRIu8 ")", 
	      bits(cmd,7,1,7), bits(cmd,6,0,6));
      break;
    case 7:
      fprintf(stderr, "LinkCN %" PRIu8 " (button %" PRIu8 ")", 
	      bits(cmd,7,0,8), bits(cmd,6,0,6));
      break;
    default:
      fprintf(stderr, "WARNING: Unknown link instruction");
  }
}

static void print_jump_instruction(cmd_t *cmd) {
  switch(bits(cmd,1,4,4)) {
    case 1:
      fprintf(stderr, "Exit");
      break;
    case 2:
      fprintf(stderr, "JumpTT %" PRIu8, bits(cmd,5,1,7));
      break;
    case 3:
      fprintf(stderr, "JumpVTS_TT %" PRIu8, bits(cmd,5,1,7));
      break;
    case 5:
      fprintf(stderr, "JumpVTS_PTT %" PRIu8 ":%" PRIu16, 
	      bits(cmd,5,1,7), bits(cmd,2,6,10));
      break;
    case 6:
      switch(bits(cmd,5,0,2)) {
        case 0:
          fprintf(stderr, "JumpSS FP");
          break;
        case 1:
          fprintf(stderr, "JumpSS VMGM (menu %" PRIu8 ")", bits(cmd,5,4,4));
          break;
        case 2:
          fprintf(stderr, "JumpSS VTSM (vts %" PRIu8 ", title %" PRIu8 
		  ", menu %" PRIu8 ")", 
		  bits(cmd,4,0,8), bits(cmd,3,0,8), bits(cmd,5,4,4));
          break;
        case 3:
          fprintf(stderr, "JumpSS VMGM (pgc %" PRIu8 ")", bits(cmd,2,1,15));
          break;
        }
      break;
    case 8:
      switch(bits(cmd,5,0,2)) {
        case 0:
          fprintf(stderr, "CallSS FP (rsm_cell %" PRIu8 ")",
              bits(cmd,4,0,8));
          break;
        case 1:
          fprintf(stderr, "CallSS VMGM (menu %" PRIu8 
		  ", rsm_cell %" PRIu8 ")", bits(cmd,5,4,4), bits(cmd,4,0,8));
          break;
        case 2:
          fprintf(stderr, "CallSS VTSM (menu %" PRIu8 
		  ", rsm_cell %" PRIu8 ")", bits(cmd,5,4,4), bits(cmd,4,0,8));
          break;
        case 3:
          fprintf(stderr, "CallSS VMGM (pgc %" PRIu8 ", rsm_cell %" PRIu8 ")", 
		  bits(cmd,2,1,15), bits(cmd,4,0,8));
          break;
      }
      break;
    default:
      fprintf(stderr, "WARNING: Unknown Jump/Call instruction");
  }
}

static void print_system_set(cmd_t *cmd) {
  int i;
  
  switch(bits(cmd,0,4,4)) {
    case 1: // Set system reg 1 &| 2 &| 3 (Audio, Subp. Angle)
      for(i = 1; i <= 3; i++) {
        if(bits(cmd,2+i,0,1)) {
          print_system_reg(i);
          fprintf(stderr, " = ");
          print_reg_or_data_2(cmd,bits(cmd,0,3,1), 2 + i);
          fprintf(stderr, " ");
        }
      }
      break;
    case 2: // Set system reg 9 & 10 (Navigation timer, Title PGC number)
      print_system_reg(9);
      fprintf(stderr, " = ");
      print_reg_or_data(cmd,bits(cmd,0,3,1), 2);
      fprintf(stderr, " ");
      print_system_reg(10);
      fprintf(stderr, " = %" PRIu8, bits(cmd,5,0,8)); // ??
      break;
    case 3: // Mode: Counter / Register + Set
      fprintf(stderr, "SetMode ");
      if(bits(cmd,5,0,1))
	fprintf(stderr, "Counter ");
      else
	fprintf(stderr, "Register ");
      print_reg(bits(cmd,5,4,4));
      print_set_op(0x1); // '='
      print_reg_or_data(cmd,bits(cmd,0,3,1), 2);
      break;
    case 6: // Set system reg 8 (Highlighted button)
      print_system_reg(8);
      if(bits(cmd,0,3,1)) // immediate
        fprintf(stderr, " = 0x%x (button no %d)", 
		bits(cmd,4,0,16), bits(cmd,4,0,6));
      else
        fprintf(stderr, " = g[%" PRIu8 "]", bits(cmd,5,4,4));
      break;
    default:
      fprintf(stderr, "WARNING: Unknown system set instruction (%i)", 
	      bits(cmd,0,4,4));
  }
}

static void print_set_version_1(cmd_t *cmd) {
  uint8_t set_op = bits(cmd,0,4,4);
  
  if(set_op) {
    print_reg(bits(cmd,3,0,8));
    print_set_op(set_op);
    print_reg_or_data(cmd,bits(cmd,0,3,1), 4);
  } else {
    fprintf(stderr, "NOP");
  }
}

static void print_set_version_2(cmd_t *cmd) {
  uint8_t set_op = bits(cmd,0,4,4);
  
  if(set_op) {
    print_reg(bits(cmd,1,4,4));
    print_set_op(set_op);
    print_reg_or_data(cmd,bits(cmd,0,3,1), 2);
  } else {
    fprintf(stderr, "NOP");
  }
}

static void print_set_version_3(cmd_t *cmd) {
  uint8_t set_op = bits(cmd,0,4,4);
  
  if(set_op) {
    print_reg(bits(cmd,1,4,4));
    print_set_op(set_op);
    if(bits(cmd,0,3,1)) { // print_reg_or_data
      int i = bits(cmd,2,0,16);
      
      fprintf(stderr, "0x%x", i);
      if(isprint(i & 0xff) && isprint((i>>8) & 0xff))
	fprintf(stderr, " (\"%c%c\")", 
		(char)((i>>8) & 0xff), (char)(i & 0xff));
    } else {
      print_reg(bits(cmd,2,0,8));
    }
  } else {
    fprintf(stderr, "NOP");
  }
}

static void print_command(cmd_t *cmd) {
  switch(bits(cmd,0,0,3)) { /* three first bits */
    case 0: // Special instructions
      print_if_version_1(cmd);
      print_special_instruction(cmd);
      break;
    case 1: // Jump/Call or Link instructions
      if(bits(cmd,0,3,1)) {
        print_if_version_2(cmd);
        print_jump_instruction(cmd);
      } else {
        print_if_version_1(cmd);
        print_link_instruction(cmd,0); // must be pressent
      }
      break;
    case 2: // Set System Parameters instructions
      print_if_version_2(cmd);
      print_system_set(cmd);
      print_link_instruction(cmd,1); // either 'if' or 'link'
      break;
    case 3: // Set General Parameters instructions
      print_if_version_3(cmd);
      print_set_version_1(cmd);
      print_link_instruction(cmd,1); // either 'if' or 'link'
      break;
    case 4: // Set, Compare -> LinkSub instructions
      print_set_version_2(cmd);
      fprintf(stderr, ", ");
      print_if_version_4(cmd);
      print_linksub_instruction(cmd);
      break;
    case 5: // Compare -> (Set and LinkSub) instructions
      if(bits(cmd,0,3,1))
	print_if_version_5(cmd);
      else
	print_if_version_1(cmd);
      fprintf(stderr, "{ ");
      print_set_version_3(cmd);
      fprintf(stderr, ", ");
      print_linksub_instruction(cmd);
      fprintf(stderr, " }");
      break;
    case 6: // Compare -> Set, always LinkSub instructions
      if(bits(cmd,0,3,1))
	print_if_version_5(cmd);
      else
	print_if_version_1(cmd);
      fprintf(stderr, "{ ");
      print_set_version_3(cmd);
      fprintf(stderr, " } ");
      print_linksub_instruction(cmd);
      break;
    default:
      fprintf(stderr, "WARNING: Unknown instruction type (%i)", 
	      bits(cmd,0,0,3));
  }
}

void vmPrint_mnemonic(vm_cmd_t *command)  {
  int i, extra_bits;
  cmd_t cmd;
  
  for(i = 0; i < 8; i++) {
    cmd.bits[i] = command->bytes[i];
    cmd.examined[i] = 0;
  }

  print_command(&cmd);
  
  // Check if there still are bits set that were not examined
  extra_bits = 0;
  for(i = 0; i < 8; i++)
    if(cmd.bits[i] & ~ cmd.examined[i]) {
      extra_bits = 1;
      break;
    }
  if(extra_bits) {
    fprintf(stderr, " [WARNING, unknown bits:");
    for(i = 0; i < 8; i++)
      fprintf(stderr, " %02x", cmd.bits[i] & ~ cmd.examined[i]);
    fprintf(stderr, "]");
  }
}

void vmPrint_CMD(int row, vm_cmd_t *command) {
  int i;

  fprintf(stderr, "(%03d) ", row + 1);
  for(i = 0; i < 8; i++)
    fprintf(stderr, "%02x ", command->bytes[i]);
  fprintf(stderr, "| ");

  vmPrint_mnemonic(command);
  fprintf(stderr, "\n");
}