servocmd.c

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

/* Copyright 1998-1999, ESS Technology, Inc.		*/
/* SCCSID @(#)servocmd.c	4.1 11/05/02 */

/*
 * $Log$
 */

/***************************************************************************
 *  There are 3 pickup type that will be supported, namely:
 *   1.  Sony KSL-213
 *   2.  Sanyo DA11T3
 *   3.  Philips L1201 (in progress, not ready yet)
 *
 *  There are 4 pickup servo parameters available as a define option:
 *   #define KSL_213    1  <-- to select original KSL-213 parameters
 *   #deifne NEW_KSL213 1  <-- new coefficient that improve on DVCD
 *   #define DA11T3     1  <-- select Sanyo DA11T3 parameters
 *   #define VAM1210	1  <-- select Philips VAM1210 parameters
 *  You can only select ONLY 1 define in the above selections
 *
 *  For Eraser Rev-A3B3 board, you have to use the correct resistors:
 *   ----------------------------------
 *    R		KSL213	NEW_KSL213	DA11T3
 *   ----------------------------------
 *   R202	39K		68K			18K
 *   R203	27K		27K			15K
 *   R209	150K	120K		150K
 *   R210	47K		47K			68K
 *   R211	47K		47K			68K
 *   R212	47K		47K			68K
 *   R213	47K		47K			68K
 *   R214	150K	120K		150K
 ***************************************************************************/

#define KSL213     1	/* original coefficent for Sony KSL-213 PUH */
#define NEW_KSL213 0	/* new coefficient 4/11/2000 that improve on DVCD */
#define DA11T3     0	/* coefficient definition for Sanyo DA11T3 PUH */
#define VAM1210    0	/* coefficient definition for Philips VAM1210 PUH */

#ifdef TCSERVO
unsigned int TINIT_9432[] =
{
#if NEW_KSL213
	0x9005,	0x9200,	0x93ff,
	0x9600,	0x9702,
	0x9820,	0x9901,	0x9b6c,
	0x9c4a,	0x9d00,	0x9e00,	0x9f00,
	0xd480,
	0xe070,	0xe122,	0xe300,
	0xe46c,	0xe5e2,	0xe631,	0xe700,
	0xe8cc,	0xea0f,	0xeb00,
	0xec08,	0xed08,	0xee09,	0xef00,
#endif NEW_KSL213

#if KSL213
/***********************************************************************
 *	990623 TC_INTERPOLATION start
 *   0x90c5, 0x91B0, 0x9200, 0x93FF,	----> 9xxx	9170->9130
 *   delete 0x91B0 from default command as it send depend on track type
 *	990623 TC_INTERPOLATION end
 **********************************************************************/
    0x90c5, 0x9200, 0x93FF,			/*	9xxx	9170->9130	*/
    0x9600, 0x9702,
    0x9b6c,
    0x9c4a, 0x9d00, 0x9e00,
    0xd480,							/*	Dxxx			*/
    0xe070, 0xe122,					/*	Exxx			*/
    0xe46c, 0xe5e2, 0xe631, 0xe700,
    0xe8cc, 0xea0f, 0xeb00,
    0xec08, 0xed00, 0xee09, 0xef00,
#endif KSL213

#if DA11T3
    0x9005, 0x9200, 0x93FF,			/*	9xxx	9170->9130	*/
    0x9600, 0x9700, 0x9820, 0x9901,
    0x9b4c,
    0x9c4a, 0x9d00, 0x9e00, 0x9f00,
    0xd480,							/*	Dxxx			*/
    0xe070, 0xe100, 0xe300,			/*	Exxx			*/
    0xe46c, 0xe5e2, 0xe631, 0xe700,
    0xe8c0, 0xea0f, 0xeb00,
    0xec08, 0xed00, 0xee09, 0xef00,
#endif DA11T3

#if VAM1210
    0x90c5, 0x9200, 0x93FF,		 	/* 9xxx	9170->9130 */
    0x9600, 0x9702, 0x9905,
    0x9b6c,
    0x9c4a, 0x9d00, 0x9e00,			/*0x9f00,*/
    0xd480,							/* Dxxx	*/
    0xe070, 0xe122,					/* Exxx	*/
    0xe46c, 0xe5e2, 0xe631, 0xe700,
    0xe8cc, 0xeacf, /* ea0f*/ 0xeb00,
    0xec08, 0xed00, 0xee09, 0xef00,
#endif VAM1210

    0x0000
};

unsigned int TINIT9296EQ[] =
{
#if NEW_KSL213
	/* F0X */
	0x07ff,0x0825,0x06c0,0x083d,
	0x07b8,0x003a,0x003a,0x0011,
	0x07f7,0x0020,0x0200,0x0040,
	0x0100,0x0059,0x07fa,0x00aa,
	/* F1X */
	0x07ff,0x084c,0x0470,0x083d,
	0x07b8,0x01a0,0x01a0,0x0011,
	0x07f7,0x0020,0x0200,0x0700,
	0x0800,0x07fd,0x0400,0x0020,
	/* F2X */
	0x07ff,0x0825,0x06e0,0x083e,
	0x07b4,0x0060,0x0060,0x0011,
	0x07f7,0x0020,0x0000,0x0000,
	0x0004,0x0059,0x07fa,0x00aa,
	/* F3X */
	0x07ff,0x0825,0x06e0,0x083e,
	0x07b4,0x0060,0x0060,0x0011,
	0x07f7,0x0020,0x0222,0x07f1,
	0x001a,0x07fc,0x0dfd,0x020c,
	/* F4X */
	0x0fe0,0x0400,0x0040,0x0100,
	0x0000,0x0044,0x06f0,0x0044,
	0x06f0,0x003a,0x07e3,0x02e0,
	0x07ff,0x07fe,0x0800,0x0d00,
	/* F5X */
	0x01e6,0x0800,0x00cd,0x0740,
	0x0800,0x0740,0x0fc0,0x0100,
	0x0200,0x0c00,0x0fc0,0x0010,
	0x0f73,0x0773,0x0040,0x003c,
	/* F6X */
	0x03e0,0x0fc4,0x0a00,0x0010,
	0x0780,0x0038,0x0000,0x0000,
	0x0000,0x0000,0x0000,0x0000,
	0x0000,0x0000,0x07ff,0x0020,
	/* F7X */
	0x0000,0x0000,0x0800,0x0800,
	0x0400,0x0c00,0x0200,0x0200,
	0x0400,0x0200,0x0280,0x0200,
	0x0200,0x0049,0x0100,0x00f0,
	/* F8X */
	0x0100,0x0040,0x0fe0
#endif NEW_KSL213

#if KSL213
    /*  address name   KS-213 */
    0x07ff,0x0828,0x0700,0x0000,	/*	F0X xxx		*/
    0x0000,0x0020,0x0030,0x000c,
    0x07fa,0x0030,0x0400,0x0080,
    0x0100,0x0080,0x07d2,0x02e0,

    0x07ff,0x082f,0x0685,0x0000,	/*	F1X xxx		*/
    0x0000,0x0090,0x0090,0x0010,
    0x07fa,0x0050,0x0200,0x0700,
    0x0800,0x07fd,0x0400,0x0020,

    0x07ff,0x0825,0x0620,0x0000,	/*	F2X xxx		*/
    0x0000,0x00e0,0x00f0,0x000b,
    0x07fa,0x0056,0x0000,0x0000,
    0x0008,0x0080,0x07d2,0x02e0,

    0x07ff,0x0825,0x0620,0x0000,	/*	F3X xxx		*/
    0x0000,0x00e0,0x00f0,0x000b,
    0x07fa,0x0056,0x0222,0x07f1,
    0x0030,0x07fc,0x0b8f,0x0485,

    0x0fe0,0x0600,0x0080,0x0100,	/*	F4X xxx		*/
    0x0000,0x0044,0x06f0,0x0044,
    0x06f0,0x0050,0x07c6,0x02e0,
    0x07ff,0x07fe,0x0800,0x0400,

    0x00f6,0x0800,0x00cd,0x0740,	/*	F5X xxx		*/
    0x0800,0x0740,0x0fc0,0x0100,
    0x0200,0x0c00,0x0fc0,0x0010,
    0x0f73,0x0773,0x0040,0x0040,

    0x03e0,0x0fc0,0x0a00,0x0010,	/*	F6X xxx		*/
    0x0780,0x0038,0x0000,0x0000,
    0x0000,0x0000,0x0000,0x0000,
    0x0000,0x0000,0x0008,0x0020,

    0x0000,0x0000,0x0800,0x0800,	/*	F7X xxx		*/
    0x0400,0x0c00,0x0200,0x0200,
    0x0400,0x0200,0x0150,0x0100,
    0x0200,0x0048,0x00c0,0x00d0,

    0x0100,0x0040,0x0fe0		/*	F8X xxx		*/
#endif KSL213

#if DA11T3
    0x07ff,0x0825,0x0710,0x0000,	/*	F0X xxx		*/
    0x0000,0x0025,0x0025,0x000b,
    0x07fa,0x0056,0x0400,0x0080,
    0x0100,0x0080,0x07d2,0x02e0,

    0x07ff,0x082c,0x0660,0x0000,	/*	F1X xxx		*/
    0x0000,0x0085,0x0090,0x000b,
    0x07fa,0x0056,0x0200,0x0700,
    0x0800,0x07fd,0x0400,0x0020,

    0x07ff,0x0825,0x0700,0x0000,	/*	F2X xxx		*/
    0x0000,0x0037,0x0037,0x000b,
    0x07fa,0x0080,0x0000,0x0000,
    0x0008,0x0080,0x07d2,0x02e0,

    0x07ff,0x0825,0x0700,0x0000,	/*	F3X xxx		*/
    0x0000,0x0037,0x0037,0x000b,
    0x07fa,0x0080,0x0222,0x07f1,
    0x0010,0x07fc,0x0ef1,0x0114,

    0x0fe0,0x0600,0x0080,0x0100,	/*	F4X xxx		*/
    0x0000,0x0044,0x06f0,0x0044,
    0x06f0,0x0050,0x07c6,0x02e0,
    0x07ff,0x07fe,0x0800,0x0c00,

    0x01e6,0x0800,0x00cd,0x0740,	/*	F5X xxx		*/
    0x0800,0x0740,0x0fc0,0x0100,
    0x0200,0x0c00,0x0fc0,0x0010,
    0x0f73,0x0773,0x0040,0x0040,

    0x03e0,0x0fc0,0x0a00,0x0010,	/*	F6X xxx		*/
    0x0780,0x0027,0x0000,0x0000,
    0x0000,0x0000,0x0000,0x0000,
    0x0000,0x0000,0x07ff,0x0020,

    0x0000,0x0000,0x0800,0x0800,	/*	F7X xxx		*/
    0x0400,0x0c00,0x0200,0x0200,
    0x0400,0x0200,0x0280,0x01a0,
    0x0200,0x0040,0x00f0,0x00f0,

    0x0270,0x0040,0x0ef0			/*	F8X xxx		*/
#endif DA11T3

#if VAM1210
    0x07ff,0x0820,0x0700,0x0000,    /*      F0X xxx         */
    0x0320,0x0030,0x0030,0x000c,
    0x07f8,0x0048,0x0400,0x0080,
    0x0100,0x0080,0x07d2,0x02e0,

    0x07ff,0x082f,0x0685,0x0000,	/*	F1X xxx		*/
    0x0000,0x0090,0x0090,0x0010,
    0x07fa,0x0050,0x0200,0x0700,
    0x0800,0x07fd,0x0400,0x0020,

    0x07ff,0x0815,0x06f0,0x0000,    /*      F2X xxx         */
    0x0320,0x0032,0x0032,0x000c,
    0x07ff,0x000d,0x0000,0x0000,
    0x0008,0x0080,0x07d2,0x02e0,

    0x07ff,0x0820,0x0650,0x0000,    /*      F3X xxx         */
    0x0000,0x00e0,0x00f0,0x000b,
    0x07fa,0x0056,0x0222,0x07f1,
    0x0030,0x07fc,0x0b8f,0x0485,

    0x0fe0,0x0600,0x0080,0x0100,	/*	F4X xxx		*/
    0x0000,0x0044,0x06f0,0x0044,
    0x06f0,0x0050,0x07c6,0x02e0, 0x07ff,0x07fe,0x0800,0x0ea0,

    0x01e6,0x0800,0x00cd,0x0740,    /*      F5X xxx         */
    0x0800,0x0740,0x0fc0,0x0100,
    0x0200,0x0c00,0x0fc0,0x0010,
    0x0f73,0x0773,0x0040,0x0040,

    0x03e0,0x0fc0,0x0a00,0x0010,	/*	F6X xxx		*/
    0x0780,0x0050,0x0000,0x0000,
    0x0000,0x0000,0x0000,0x0000,
    0x0000,0x0000,0x0003,0x0020,

    0x0000,0x0000,0x0800,0x0800,	/*	F7X xxx		*/
    0x0400,0x0c00,0x0200,0x0200,
    0x0400,0x0200,0x0280,0x0200,
    0x0200,0x0048,0x00c0,0x00d0,

    0x0100,0x0040,0x0fe0,0x00c0                /*      F8X xxx         */
#endif VAM1210
};

unsigned int AMinuteTrack[] =
{
    0,  451,  891, 1319, 1736, 2144, 2543, 2933, 3315,3689,
    4056, 4417, 4771, 5119, 5462, 5799, 6131, 6457, 6779,7097,
    7410, 7719, 8023, 8324, 8621, 8915, 9205, 9492, 9776,10056,
    10333,10608,10879,11148,11414,11678,11939,12198,12454,12708,
    12959,13209,13456,13701,13945,14186,14425,14663,14898,15132,
    15364,15594,15823,16050,16275,16499,16721,16941,17161,17378,
    17595,17810,18023,18235,18446,18656,18864,19071,19277,19481,
    19685,19887,20088,20288,20487,20685,20881,21077,21272,21465,
    21658
#if 1	/* CHANGE0712 002 - Extent Abs.Minute Domain to 105 */
/*****************************************************************
   ,21850,22042,22233,22424,22614,22804,22993,23182,23370,
   23557,23743,23928,24112,24295,24477,24658,24838,25017,25195,
   25372,25548,25723,25897,26070
 *****************************************************************/
    ,21700,21720,21740,21760,21780
    ,21800,21820,21840,21860,21880
    ,21900,21920,21940,21960,21980
    ,22000,22020,22040,22060,22080
    ,22100,22120,22140,22160
#endif
};

#else TCSERVO
/*unsigned char mute_cmd[] = {0x0,0x3,0xa,0xff};*/
unsigned char mute_cmd[] = {0x0,0x2,0xa,0xff};
unsigned char unmute_cmd[]={0x0,0x0,0xa,0xff};

unsigned char reset_cmd1[]={0x0,0x3,0xa,0xff};
/*
unsigned char focus_cmd1[]={0x0,0x0,0x0,0x4,0xff,0x0,0x0,0xff,0x5,0x5,0xff};
*/
unsigned char focus_cmd1[]={0x0,0x0,0x0,0x4,0xff,0x0,0x0,0xff,0xa,0x5,0xff};
unsigned char focus_cmd11[]={0x0,0x0,0x0,0x8,0xff,0x0,0x0,0xa,0xff,0x0,0x6,
                             0xc,0xff,0x0,0x0,0x6,0xd,0xff};
unsigned char focus_cmd2[]={0x0,0xb,0x9,0xff,0x0,0x0,0x7,0x4,0xff};
unsigned char focus_cmd3[]={0x0,0x0,0x0,0x4,0xff};

/*
 *  unsigned char track_jump_time1[]={0x5,0x5,0xff};
 */

unsigned char track_jump_time16[]={0x7,0x5,0xff,0x0,0x1,0x6,0xff,0x8,0x0,0x0,
                                   0x0,0x7,0xff};
unsigned char track_jump_time32[]={0x7,0x5,0xff,0x0,0x1,0x6,0xff,0x0,0x1,0x0,
                                   0x0,0x7,0xff};
unsigned char track_jump_time64[]={0x7,0x5,0xff,0x0,0x1,0x6,0xff,0x0,0x2,0x0,
                                   0x0,0x7,0xff};
unsigned char track_jump_time128[]={0x7,0x5,0xff,0x0,0x2,0x6,0xff,0x0,0x4,0x0,
                                    0x0,0x7,0xff};
unsigned char track_jump_time240[]={0x8,0x5,0xff,0x0,0x4,0x6,0xff,0x0,0x8,0x0,
                                    0x0,0x7,0xff};

/*
 *  unsigned char track_jump_in_cmd1[]={0xc,0x1,0xff,0x0,0x0,0x8,0x4,0xff};
 */

unsigned char track_jump_in_cmd16[]={0xc,0x1,0xff,0x0,0x0,0xc,0x4,0xff};
unsigned char track_jump_in_cmd32[]={0xc,0x1,0xff,0x0,0x0,0xc,0x4,0xff};
unsigned char track_jump_in_cmd64[]={0xc,0x1,0xff,0x0,0x0,0xc,0x4,0xff};
unsigned char track_jump_in_cmd128[]={0xc,0x1,0xff,0x0,0x0,0xc,0x4,0xff};
unsigned char track_jump_in_cmd240[]={0xc,0x1,0xff,0x0,0x0,0xc,0x4,0xff};

/*
 *  unsigned char track_jump_out_cmd1[]={0xc,0x1,0xff,0x0,0x0,0x9,0x4,0xff};
 */

unsigned char track_jump_out_cmd16[]={0xc,0x1,0xff,0x0,0x0,0xd,0x4,0xff};
unsigned char track_jump_out_cmd32[]={0xc,0x1,0xff,0x0,0x0,0xd,0x4,0xff};
unsigned char track_jump_out_cmd64[]={0xc,0x1,0xff,0x0,0x0,0xd,0x4,0xff};
unsigned char track_jump_out_cmd128[]={0xc,0x1,0xff,0x0,0x0,0xd,0x4,0xff};
unsigned char track_jump_out_cmd240[]={0xc,0x1,0xff,0x0,0x0,0xd,0x4,0xff};
unsigned char track_jump_cancelcmd[]={0x0,0x0,0x0,0x4,0xff,0x8,0x1,0xff,0x8,
                                      0x0,0xff,0x5,0x2,0xff};
unsigned char clvon_cmd1[]={0x0,0x0,0x8,0xe,0xff};
unsigned char clvon_cmd2[]={0x00,0x0,0x6,0xe,0xff,0x4,0x2,0xff,0x8,0x1,0xff};
unsigned char clvon_cmd3[]={0x5,0x2,0xff,0x8,0x0,0xff,0x8,0x1,0xff};
unsigned char stop_cmd1[]={0x4,0x2,0xff,0x0,0x0,0xa,0xe,0xff};
unsigned char stop_cmd2[]={0x0,0x0,0x0,0x4,0xff,0x0,0x0,0x0,0xe,0xff,0x0,0x2,
                           0xff,0x0,0x0,0xff};

/*
 *  unsigned char sled_in[]={0x3,0x2,0xff};
 *  unsigned char sled_out[]={0x2,0x2,0xff};
 *  unsigned char sled_stop[]={0x0,0x2,0xff};
 *  unsigned char test_cmd1[]={0x8,0x1,0xff};
 */

#ifdef CMDINROM
unsigned char track_jump_time1[]={0x5,0x5,0xff};
unsigned char track_jump_in_cmd1[]={0xc,0x1,0xff,0x0,0x0,0x8,0x4,0xff};
unsigned char track_jump_out_cmd1[]={0xc,0x1,0xff,0x0,0x0,0x9,0x4,0xff};
unsigned char sled_in[]={0x3,0x2,0xff};
unsigned char sled_out[]={0x2,0x2,0xff};
unsigned char sled_stop[]={0x0,0x2,0xff};
unsigned char test_cmd1[]={0x8,0x1,0xff};
#endif CMDINROM

#endif TCSERVO