dsak.c

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

/* Copyright 2001, ESS Technology, Inc. */
/* SCCSID @(#)dsak.c	4.36 01/17/05 */

/*
 * This is based on version 2.11 of dsas.c 
 */

/*
 * 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"
#ifdef TWO_FIELDS_OSD 
#include "cg.h"
#else
#include "fsosd.h"
#endif

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

#ifdef SERVO
#include "servo.h"
#endif SERVO

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

#ifdef ANTI_SHOCK
#include "recorder.h"
#endif ANTI_SHOCK

/*------------------------------------------------------------------------
 * Debugging macros
 *------------------------------------------------------------------------*/
#ifdef DEBUG_OSD
extern int osdreg;
#define CPRINTF(a,b) {osdreg+=3;if(osdreg>13)osdreg=1;debug_osd(a,b,osdreg);}
#else
#define CPRINTF(a,b)
#endif

#if 0
int bpt;
#define BREAKPOINT(x) {bpt=x;while(bpt) VCX_service();}
#else
#define BREAKPOINT(x)
#endif

/************************************************************************
 *   DSA variables , for CD control					*
 ************************************************************************/
#ifdef SERVO
IMPORT char	servo_focus_on, kickfg, SERVO_new_Qcode, SERVO_mode;
IMPORT unsigned char SERVO_Qarray_new[], SERVO_Qarray_current[];
IMPORT uint 	SERVO_target_msf;

IMPORT int SERVO_stop(int);
IMPORT int SERVO_close();
IMPORT int SERVO_open();
IMPORT int SERVO_search();
#if 0
IMPORT void SERVO_digital_pll();
IMPORT void SERVO_init_parameter();
#endif

#endif SERVO

/*
 * set to 1 for active high limit switch setting
 * set to 0 for active low limit switch setting
 */
char limit_sw_active_high = 1;


/************************************************************************
 * Global variables							*
 ************************************************************************/
int ltoc_done;              /* LTOC is done                         */

#ifdef SONY3D
int             TrayStatus;
extern char     int_eject;
extern int      cd_disc_slot;
#endif

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 */
unsigned char	*CDI_ptr;

#if (defined(GBPINS_SHARE) || defined(COMMON_OPEN_CLOSE))
char	share_open_close = SHARE_OPEN;	/* 0 means use separate AUX pins*/
					/* for OPEN and CLOSE  		*/
					/* 1 OPEN/CLOSE share open pin	*/
					/* 2 OPEN/CLOSE share close pin	*/
#else
char    share_open_close = 0;
#endif

/************************************************************************
 * Variables local to this module					*
 ************************************************************************/
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.				*/

PRIVATE unsigned int	CDDA_play_time;	/* Play time for current track	*/
PRIVATE unsigned int    CDDA_track_start_time;

/* States in dsa_go_step_by_step */
#define	DSA_GO_INIT		0
#define DSA_GO_STILL_SEARCHING	1
#define DSA_GO_FOUND_TARGET	2
int	dsa_go_state = DSA_GO_INIT;
/************************************************************************
 * 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	*/
#ifdef SERVO_7
DEBUGVAR(dbgDSAcleartoc,0);     /* Debug variable for dsa_cleartoc routine */
#endif
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(dbgTransDsa, 0);	/* Debug variable for trans_dsa		*/
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(dbgMaxRcvElapse, 0);	/* Max. elapsed time for receive_dsa_all*/
DEBUGVAR(dbgMaxTran, 0);	/* Max. number of trans_dsa loop count	*/
DEBUGVAR(dbgMaxTranElapse, 0);	/* Max. elapsed time for trans_dsa	*/
DEBUGVAR(dbgServoRcv, 0);	/* receive_dsa_all time out		*/
DEBUGVAR(dbgServoTran, 0);	/* trans_dsa time out			*/
DEBUGVAR(dbgMaxLtocCnt, 0);	/* Max. number of LTOC replies		*/

/************************************************************************
 * Global functions
 ************************************************************************/
PUBLIC	int		dsa_go(unsigned int);

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


/************************************************************************
 * New defined functions to check 74ls244 input port status             *
 ************************************************************************/
#ifdef SONY3D
int	servo_check_rssw();
int	servo_check_stsw();
int	servo_check_ior3();
int	servo_check_up();
int	servo_check_down();
void    TRAY_init();
PRIVATE void searchDisc1();
PRIVATE void process_eject();
PRIVATE void process_up_down();
#endif /* SONY3D */

/************************************************************************
 * Imported functions							*
 ************************************************************************/
IMPORT	void		DISP_cigam();
IMPORT	void		DISP_naicigam();
void CUST_init()
{
    vcx_cd_drive = CD_SONY;
#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];
*/
IMPORT int q;

void test_dsa()
{
    switch (abc) {
    case 1:
	dsa_open();
	break;
    case 2:
	dsa_close(0);
	break;
    case 3:
	initMicroObject();
	break;
    case 4:
	initCD();
	break;
    case 5:
	dsa_stop();
/*
	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 0
    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 */


#ifdef SONY3D
    process_eject();
#endif

    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 */
	    
	    initCD();		/* Customize your init CD routine	*/
	}
	power_up = 0;		/* Reset after initCD() 		*/
    } else {
	DEBUGINC(1, dbgServiceVcxi);
	receive_dsa();
/*
	test_dsa();
*/
	DEBUGINC(1, dbgSafeServiceVcxi);
	DEBUGASSIGN(glbSec, (glbTimer / ((currentTVmode == TV_PAL) ? 50 : 60)));

#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;


    /* 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)||forceDSAabort) { 
		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 + HALF_SECOND;
	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;
	    }
	    check_user_input();
#ifdef SERVO
	    SERVO_service(1);
	    if (!servo_focus_on)
		return (-1);	/* Focus is down, do not proceed */
#endif
	}

	/* check if the data tranfer is done */
	if (!timeout) {