tcservo.c

ESS3890+SL原代码（1*16内存）

/* Copyright 1998-1999, ESS Technology, Inc.	*/
/* SCCSID @(#)tcservo.c	4.27 01/17/05 */

/*
 * This is based on version 1.9(01/08/99) of dsat.c for VCD
 * This is for TCSERVO
 */

/*
 * Many of the DSA routines are actual SERVO routines if -DSERVO
 */

#include <stdio.h>
#include <stdlib.h>
#include <ctype.h>
#include "vcxi.h"
#include "buffer.h"
#include "const.h"
#include "cd.h"
#include "debug.h"
#include "display.h"
#include "dsa.h"
#include "micro.h"
#include "tdm.h"
#include "timedef.h"
#include "util.h"
#include "play.h"
#include "vscale.h"
#include "xport.h"
#include "vp.h"
#include "echo.h"
#include "servo.h"
#ifdef TWO_FIELDS_OSD 
#include "cg.h"
#else
#include "fsosd.h"
#endif

#ifdef FRACTINT
#include "fractint.h"
#endif

#ifdef MP3
#include "mp3.h"
#endif MP3


#if 0
#define DPRINTF(a) printf a
#else
#define DPRINTF(a)
#endif

int search_timer;
/****************************************************************************
        Flags Definitions
****************************************************************************/
int servo_flags = 0;
/*
bit 0 - 1 : rough search, 0 : fine search
bit 1 - 1 : in search mode, 0 : in play mode ( pause, FF, FB, slow also )
bit 2 - 1 : Servo Abort
bit 3 - 1 : Servo on with adjustment
*/
int mode_flags;
/*
bit 0 : 1 - close mode, 0 - open mode
bit 1 : 1 - access mode, 0 - stop mode
bit 2 : 1 - pause mode, 0 - play mode
bit 3 : 1 - tray blocked recorded
*/


/************************************************************************
 *   DSA variables , for CD control					*
 ************************************************************************/
extern int run_time;			/* absolute time format ttmmssff */
extern unsigned int SERVO_Qarray_new[], SERVO_Qarray_current[];
extern int target_min, target_sec, target_frame;

extern int mode_flags;

extern int SERVO_mode;
extern int SERVO_state;
extern int servo_flags;
/* Following are old method */
extern unsigned int SERVO_Qarray_new[];
unsigned char Qcode[10];
extern unsigned int SERVO_Qarray_new[], SERVO_Qarray_current[];
extern int target_min, target_sec, target_frame;
extern int SERVO_stop(int);


extern int vcd20_start, vcd20_end;


/************************************************************************
 * Global variables							*
 ************************************************************************/

CDINFO CDinfo;
int power_up = 1;		/* Flag is set to 0 after system starts. */
int num_of_track;		/* # of tracks in the CD 		 */
int first_seg_ad;		/* BCD sector location for first segment *
				 * address. Comes from INFO.VCD. It is	 *
				 * always in MM:SS:FF form. Should be	 *
				 * XXYY00. In most case, XX is 00 and 	 *
				 * YY is 05 but there is no guarantee.	 *
				 * (From INFO.VCD)			 */

int CDinited = 0;		/* 0: key info of CD has not been read	 *
				 * 1: CD info has been read/stored	 */

char forceDSAabort = 0;		/* Force DSA to quit and return as if	 *
				 * command succeed.			 */
unsigned int err_code = 0;	/* Error code from DSA routines		 */
unsigned char servo_track_changed;/* A flag indicates a new track has
				   * come. */

unsigned int servo_info;	/* store TTMMSSFF info from servo.	 */
unsigned int last_servo_info;	/* store previous TTMMSSFF info from servo. */

int currentTVmode;		/* TV_NTSC or TV_PAL */
int bcd_num_of_track;		/* used in OSD */
int save_ramcode = -1;
unsigned char *CDI_ptr;


/* Added by Mao Mar-28-2001 */
char share_open_close = 0 ;      /*  Set to 1 if use POS loader */
int use_shutter = 0;            /* Set to 1 if use Sony new Pickup
                                   with Shutter */
char shutter_opened= 1;          
/************************************************************************
 * Variables local to this module					*
 ************************************************************************/
PRIVATE unsigned int CDDA_play_time;
PRIVATE unsigned int CDDA_track_start_time;

PRIVATE int currDSAmode = 0;	/* Current CDROM's DSA mode. We'll only	*
				 * issue dsa_mode command if the new	*
				 * mode is different from the current	*
				 * mode.				 */

/* States in dsa_go_step_by_step */
#define	DSA_GO_INIT		0
#define DSA_GO_SEARCHING	1
#define DSA_GO_FOUND_TARGET	2
PRIVATE int	dsa_go_state = DSA_GO_INIT;

IMPORT int DiscMode;

/************************************************************************
 * Debug variables							*
 ************************************************************************/
DEBUGVAR(go_time, 0);		/* The last dsa_go time			 */
DEBUGVAR(dbgDSAclose, 0);	/* Debug variable for dsa_close routine	 */
DEBUGVAR(dbgDSAgo, 0);		/* Debug variable for dsa_go routine	 */
DEBUGVAR(dbgDSAmode, 0);	/* Debug variable for dsa_mode routine	 */
DEBUGVAR(dbgDSAopen, 0);	/* Debug variable for dsa_open routine	 */
DEBUGVAR(dbgDSApause, 0);	/* Debug variable for dsa_pause routine	 */
DEBUGVAR(dbgDSApauserelease, 0);/* Debug variable for dsa_pauserelease	 */
DEBUGVAR(dbgDSArelease, 0);	/* Debug variable for dsa_release	 */
DEBUGVAR(dbgDSArcv, 0);		/* Debug variable for receive_dsa	 */
DEBUGVAR(dbgDSAstop, 0);	/* Debug variable for dsa_stop routine	 */
DEBUGVAR(dbgPlaySector, 0);	/* Can't find the given sector from 20	 *
				 * frames ealier.			 */
DEBUGVAR(dbgGetSector, 0);	/* Can't get the sector (because SYNC	 *
				 * pattern is not found).		 */
DEBUGVAR(glbSec, 0);		/* Global time in seconds		 */
DEBUGVAR(dbgReceiveDsa, 0);	/* Debug variable for receive_dsa	 */
DEBUGVAR(dbgServiceVcxi, 0);	/* Number of time service_vcxi is called */
DEBUGVAR(dbgSafeServiceVcxi, 0);/* Number of "save" service_vcxi calls	 */
DEBUGVAR(dbgMaxRDSA, 0);	/* Max. RDSATimeCount			 */
DEBUGVAR(dbgMaxRcvAll, 0);	/* Max. number of receive_dsa calls	 *
				 * before we get a full piece of data	 */
DEBUGVAR(dbgMaxLtocCnt, 0);	/* Max. number of LTOC replies		 */

/************************************************************************
 * Functions declared and used within this module only.			*
 ************************************************************************/
PRIVATE int dsa_go_step_by_step(unsigned int);
PRIVATE void init_dsa(void);
PRIVATE int processCDI(unsigned int *, int);
PRIVATE void reset_dsa_go();

/************************************************************************
 * Imported functions							*
 ************************************************************************/
IMPORT void microEngine();
IMPORT void DISP_cigam();
IMPORT void DISP_naicigam();
void CUST_init()
{
    vcx_cd_drive = CD_TOSHIBA;
#ifdef EXT_INPUT
    vcx_ext_format = CD_SONY;
#endif
    vcx_xfer_mode = 5;
}

void dsa_reset()
{
    servo_info = 0;
}

#if 0				/* TESTING */

int abc;
int abc_data[100];
extern int q;

void test_dsa()
{
    switch (abc) {
	case 1:
	dsa_open();
	break;
    case 2:
	dsa_close();
	break;
    case 3:
	initMicroObject();
	break;
    case 4:
	initCD();
	break;
    case 5:
	dsa_ltoc(abc_data, 100);
	break;
    case 6:
	dsa_go(0x120000);
	system_reset();
	system_start();
	begCDtime = 0x120030;
	endCDtime = 0x999999;
	break;
    case 7:
	fuzzyPlaySector(0x120000, 2324);
	break;
    case 8:
	begCDtime = 0x120004;
	endCDtime = 0x999999;
	dsa_go(0x120000);
	system_reset();
	system_start();
	TDM_isCDDA = 0;
	XPORT_play20video(XPORT_OFFSET_FUZZY_PLAY, 0xe0);
	TDM_turn_on();
	break;
    case 9:
	playSectors(0x120000, 0xe0, 2324);
	begCDtime = 0x120004;
	endCDtime = 0x999999;
	break;
    case 10:
	system_reset();
	system_start();
	playSectors(0x500, 0x1e2, 2324);
	begCDtime = 0x500;
	endCDtime = 0x3500;
	break;
    case 11:
	fill_screen(1);
	break;
#ifdef DIGEST
    case 12:
	digestPage(0);
	q = 9;
	break;
#endif
    case 13:
	TDM_off = 1;
	while (TDM_off);

	begCDtime = 0x120004;
	endCDtime = 0x999999;
	dsa_go(0x120000);
	system_reset();
	system_start();
	TDM_isCDDA = 0;
	XPORT_play20video(XPORT_OFFSET_FUZZY_PLAY, 0xe0);
	TDM_turn_on();
	break;
    case 14:
	system_reset();
	system_start();
	playCDDA(0x010000, 0x100000);
	TDM_turn_on();
	break;
    default:
	break;
    }

    abc = 0;
}

#endif



/*
 * Service microcontroller, CD ROM (etc)
 */

void CUST_background()
{
    /*
     * If the NTSC/PAL switch is changed, then change TV mode
     * accordingly.
     *
     * NOTE: Enable POLL_TV_SWITCH only if your system has 
     * dedicated pin for TV switch. Don't enable POLL_TV_SWITCH
     * if the TV switch is shared(i.e. VFD). In that case,
     * the TV mode can only be detected at power-up.
     */
#ifdef POLL_TV_SWITCH
#ifdef DSC
    if (!IS_POWER_DOWN)
#endif
    {
	PREPARE_DETECTION;
	if (currentTVmode == TV_NTSC) {
	    if (!DETECT_NTSC)  {
		play_change_tv_mode();
	    }
	} else {
	    if (DETECT_NTSC) {
		play_change_tv_mode();    
	    }
	}
    }
#endif /* POLL_TV_SWITCH */

    if (power_up) {
	/* if in power-down mode, avoid doing power-up stuff */
	if (!IS_POWER_DOWN) {
	    initMicroObject();
	    init_dsa();
#if (defined MP3_LOGO && defined ENABLE_MP3)
#ifndef NOLOGO
	    /*moved here from top.c, for slideshow problems due to longjump*/
	    play_mp3_logo((int *)mp3logo, T_mp3logo_SZ>>2);
#endif
#ifndef MP3_LOGO_IN_SHARE
	    /* show LOGO after play_mp3_logo() */
	    show_mpeg_still(0xe1, powerupScreen, T_powerupScreen_SZ>>2);
#endif /* !MP3_LOGO_IN_SHARE */
#endif /* MP3_LOGO */
	    
	/*************************************************************/
	    Start_Close_Tray();
	    SET_close_mode;		/* Specify Close Mode */
	}
	power_up = 0;
    } else {
	receive_dsa();
/*	test_dsa();*/

#ifdef TWO_FIELDS_OSD 
        CG_service(1);
#else
        OSD_schedule_check();
#endif
	upper_state_machine(1);	/* Customize your play state machine	 */
    }
}


/************************************************************************
 * Utility routines							*
 ************************************************************************/
/*
 * Read "num" sectors into the start of the system buffer. This routine is
 * only called to get system information (not MPEG A/V data)
 *
 * Inputs:
 *	begin:   CD sector time in MMSSFF (each is in BCD)
 *	num:	 number of CD sectors to copy. This number has to be
 *		 smaller than sys_buf_size/size.
 *	dest:	 
 *		non-zero: data to VBV
 *		       0: data to ABV
 *
 * Return:
 *	-2:	force abort
 *	-1:	failed dsa_go() or servo problem
 *	 0:	if failed
 *	 1:	if successful
 */
int getSectors(begin, num, dest)
unsigned int begin;
int num, dest;
{
    unsigned int dsatime, tmp;
    unsigned int next_time;
    int xfer_done;
    int counter;
    int timeout;
    int ii;


    /* target time check..
     * make sure it's larger than Leadin + "adjustment".
     */
    if (CDtime_check(begin)|| (begin < 0x204)) return(0);

    begCDtime = begin;
    endCDtime = adjCDtime(begCDtime, logical2physical(num), 1);

    /* Set DSA_GO time to be 4d frames ealier than user specified	 */
    dsatime = adjCDtime(begCDtime, 0x4, -1);

    /* Only change DSA mode if the current mode is not CDROM		 */
    TDM_isCDDA = 0;		/* Data is scrambled (as opposed to CDDA)*/

    XPORT_load_ucode((dest) ? DATA_PS : MP3_PS);
    dsa_mode(MODE_ATTI_REL | MODE_CDROM | MODE_SPEED_NORMAL);

    counter = 0;

    do {
	xfer_done = 0;

	if (counter >= 2) {
	    DEBUGINC(1, dbgGetSector);
	    err_code = ERR_GETSECTOR;
	    return (0);
	}
	counter++;

	if (!dsa_go(dsatime)) {	/* DSA_GO command failed	 */
	    if (counter >= 2) {
		DEBUGINC(1, dbgGetSector);
		return (-1);
	    } else {
		counter++;
		continue;	/* Time not specified, don't go	 */
	    }
	}

	system_reset();
	system_start();
	TDM_isCDDA = 0;
	XPORT_play20video(XPORT_OFFSET_GET_SECTOR, 2048);
	TDM_turn_on();

        next_time = glbTimer + TWO_SECOND;/* Added by Mao Mar-28-2001 */
	timeout = 0;

	while (!TDM_found_begCDtime) {
	    /*
	     * There may not be any SYNC pattern (CDDA disk), so we'll
	     * conclude that we are not getting the data if we have been
	     * sitting here for .5 second
	     */
	    if ((glbTimer > next_time) || (currCDtime > endCDtime)) {
		/*
		 * Check one more time. In case CDI_get is cleared since I
		 * checked it the last time. If we just turn off TDM, then
		 * there is some chance that nobody will turn TDM on again
		 * (because CDI_get is cleared)
		 */
		timeout = 1;
		break;
	    }
#ifdef ECHO
	    MIC_service();
#endif
	    /* Servo Process in getSectors() */
	    ii = TC_SERVO_process();
	    if ((ii == SERVO_RET_int) ||
		(ii == SERVO_RET_fng) ||
		(ii == SERVO_RET_clvng))
		return (-1);
	}

	/* check if the data tranfer is done */