servoe.h

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

/* Copyright 2003, ESS Technology, Inc. */
/* SCCSID @(#)servoe.h	1.2 04/23/04 */

/*
 * based on version 1.5 servom.h
 */

/* dummy */
#define SET_SERVO_DIG_MUTE	VCX_service()
#define CLEAR_SERVO_DIG_MUTE	VCX_service()


/* define servo_pres_m */
#define STOP_10		5
#define STOP_20		6
#define STOP_30		7
#define STOP_40		8
#define STOP_100	9
#define STOP_110	10
#define STOP_120	11
#define STOP_200	12
#define STOP_210	13
#define STOP_220	14
#define STOP_230	15
#define FOCUS_10	16
#define FOCUS_20	17
#define FOCUS_30	18
#define FOCUS_40	19
#define FOCUS_50	20
#define FOCUS_60	21
#define EFV_10		22
#define FBIAS_10	23
#define FBIAS_20	24
#define AGC_10		25
#define AGC_20		26
#define TOC_10		27
#define ACES_10		28
#define ACES_20		29
#define ACES_30		30
#define ACES_40		31
#define CUE_10		32
#define CUE_20		33
#define CUE_30		34
#define CUE_40		35
#define PLAY_10		36
#define RUN_10		37
#define EMR_10		38
#define EMR_20		39
#define FB_SPL		60


/* define sled power level in different jump */
#define SLEDIN_IN       0
#define SLED_NORMAL     1
#define SLED_M_IN_MAX   2
#define SLED_M_IN_MIN   3
#define SLED_M_OUT_MAX   4
#define SLED_M_OUT_MIN   5
#define JUMP_2N_IN       6
#define JUMP_2N_OUT       7


/*===========================================================================
  DEFINE DSP COMMAND:
===========================================================================*/
/*INITR(80):|HOLD|FRES|TRES| 0 | 0 | 0 | 0 | 0 |*/
#define         INITR           0x80
/*PUSTP(81):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         PUSTP           0x81
/*PUFWD(82):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         PUFWD           0x82
/*PUBWD(83):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         PUBWD           0x83
/*LDON(84):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         LDON            0x84
/*LDOFF(85):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         LDOFF           0x85
/*DMSV(86):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         DMSV            0x86
/*DMOFF(87):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 |*/
#define         DMOFF           0x87
/*FOSET(88):| 0	|FGC	|HISR	|FSON	|0	|SPKSL	|SPKCL	|SPKST|*/
#define         FOSET           0x88
/*FORST(89):| 0 |FGC|HISR|FSON| 0 |SPKSL|SPKCL|SPKST|*/
#define         FORST           0x89
/*DMFBK(8A):| 0 | 0 |DMFK|DMBK| 0 | 0 | 0 | 0 |*/
#define         DMFBK           0x8A
/*AWRPLL(8B):|AWSS|AWPR|AWFS1|AWFS0|AWBW| 0 | 0 |0 |*/
#define         AWRPLL          0x8B
/*SOUND(90):|AMUT|ATTC|ATT|MUTE|DACMT|DMUT|OSEL1|OSEL0|*/
#define         SOUND3721        0x90
/*PRCSET(91):|C2CG1|C2CG0|MUTMS|ITIHS|EC/FC|PMST|CTRCL|CTCS|*/
#define         PRCSET          0x91
/*PLLMD2(92):|TMDLY|TMINV|TMGT1|TMGT0|DACDMT|SLCOHZ|DIVS|PLCKS|*/
#define         PLLMD2          0x92
/*ATTDAC(93):|DACSTP|DATT6|DATT5|DATT4|DATT3|DATT2|DATT1|DATT0|*/
#define         ATTDAC          0x93
/*ATTLA(94):|ATTA7|ATTA6|ATTA5|ATTA4|ATTA3|ATTA2|ATTA1|ATTA0|*/
#define         ATTLA           0x94
/*ATTLB(95):|ATTB7|ATTB6|ATTB5|ATTB4|ATTB3|ATTB2|ATTB1|ATTB0|*/
#define         ATTLB           0x95
/*DOUT(96):|SOC3 |SOC2 |SOC1 |SOC0 |CLA1 |CLA0 |SVSEL |EXTDG0|*/
#define         DOUT            0x96
/*EFFECT(97):|ESEL3| ESEL2 |ESEL1 |ESEL0 |BMUT |CCNT |LRCKS |EMPHS|*/
#define         EFFECT          0x97
/*DSPCNT(98):|SHS|VCOCKG|SRVUP|SRVPX|PBSPS|SLEEP|ATTABG|ATTIM|*/
#define         DSPCNT          0x98
/*SPEED(99):|UHS|HS|ZIN1|ZIN0|MCKS|MCKG|TMPS1|TMPS0|*/
#define         SPEED           0x99
/*DSLMD1(9A):|SLMOG|ASBW2|ASBW1|ASBW0|SLSF1|SLSF0|SLMNT1|SLMNTO|*/
#define         DSLMD1          0x9A
/*DSLMD2(9B):|SLSRG|SLFX5|SLFX4|SLFX3|SLFX2|SLFX1|SLFX0|SLFXG|*/
#define         DSLMD2          0x9B
/*PLLMD1(9C):|TMOS|TMSE|TMWD|SUHSOG|PDHZ|NSFG1|NSFG0|PDMS|*/
#define         PLLMD1          0x9C
/*VSPMOD(9D):|VSPM|BFRST|VCOUP1|VCOUP0|SLCKG1|SLCKG0|VCOGS1|VCOGS0|*/
#define         VSPMOD          0x9D
/*PINMOD(9E): |DACIN |MOG2 |MOG1 |MOG0 |SBSYG |SBMOD |CLCKS |PDPS|*/
#define         PINMOD          0x9E
/*TEST(9F):|EXTVCO|ECCG1|/IPFG|BIPOFF|ECCG0|DACCKG|PDEX|SLHLD|*/
#define         TEST            0x9F

/*FBA(D0):| 0 | 0 |FBAT|FBST| 0 | 0 | 0 | 0 |*/
#define         FBA             0xD0
/*FGA(D1):| 0 |FDFS|FGAT|FGST| 0 | 0 | 0 | 0 |*/
#define         FGA             0xD1
/*TBA(D2):| 0 | 0 |TBAT|TBST| 0 | 0 | 0 | 0 |*/
#define         TBA             0xD2
/*TGA(D3):| 0 | TDFS |TGAT|TGST| 0 | 0 | 0 | 0 |*/
#define         TGA             0xD3
/*FTBAST(D4):|FBAVS|TBAVS|GAVS|GQWDSL|DASEL3|DASEL2|DASEL1|DASEL0|*/
#define         FTBAST          0xD4
/*SVCNT3(D5):| 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0|*/
#define         SVCNT3          0xD5
/*SVCNT4(D6):| 0 | 0 | 0 |/PBFDM|LPFOG| 0 |DMSVG|VCOEX|*/
#define         SVCNT4          0xD6
/*DASET(D7):|DATW7|DATW6|DATW5|DATW4|DATW3|DATW2|DATW1|DATW0|*/
#define         DASET           0xD7
/*RFGA(D8):| 0 | 0 |RFGUP|RFGST| 0 | 0 | 0 | 0 |*/
#define         RFGA            0xD8
/*PBSMOD(D9):|MXSP7|MXSP6|MXSP5|MXSP4|MXSP3|MXSP2|MXSP1|MXSP0|*/
#define         PBSMOD          0xD9
/*CAVMOD(DA):|SPMOD|CAVSEL|FG3SL|FGS2|OFFADD|ALLASL| X | 1|*/
#define         CAVMOD          0xDA
/*CAVCNT(DB):|SPCNT|CAVCLV|CALVD5|CALVD4|CALVD3|CALVD2|CALVD1|CALVD0|*/
#define         CAVCNT          0xDB
/*SREG4(DC):|SRCHEQ|FDTMSL|FDLOFV|FDSMON|SMSPSL|AEXT|FOTOTR|TRTOFO|*/
#define         SREG4           0xDC
/*AWRSET(DD):|AWPR3|AWPR2|AWPR1|AWPR0|AWBL3|AWBL2|AWBL1|AWBL0|*/
#define         AWRSET          0xDD
/*SVCNT1(DE):|BRKFG|INVSIG|BRKSP1|BRKSP0|FDDMG|FFVDIV|FMCL|TEIN|*/
#define         SVCNT1          0xDE
/*SVCNT2(DF):| X |PNSEL1|PNSEL0|SBHM|LOKOUT| 0 |LAYJMP|VDCD|*/
#define         SVCNT2          0xDF


/*|FOKT1|NFOKT0|FSR1	|FSR0	|FGUP	|SBINV	|TSIFS1	|TSIFS0	|*/
#define         FSCNT           0xE0
/*|DBT3	|DBT2	|DBT1	|DBT0	|SHT3	|SHT2	|SHT1	|SHT0	|*/
#define         TIMER           0xE1
/*|FOTRSW|DMMOD|PWSEL1|PWSEL0|PWLMT3|PWLMT2|PWLMT1|PWLMT0|*/
#define         PWMLMT          0xE2
/*|DEFCNT|DEFSL|GUPMOD	|FDFSL	|HOLDS	|FDCON	|FHMUTE	|THMUTE|*/
#define         SREG0           0xE3
/*|GUPL1|GUPL0	|HYSL1	|HYSL0	|FHOLD	|THOLD	|/GUPCL	|HYSMOD|*/
#define         SREG1           0xE4
/*|GUP2	|HYS2	|GUP1	|HYS1	|HYSGUP	|SRSEL	|LOCKON	|FMSS	|*/
#define         SREG2           0xE5
/*|KICATT|KWIDSL|FVD1	|FVD0	|LIMF1	|LIMF0	|RFL		|KICCON	|*/
#define         FVSET           0xE6
/*|FDTM3|FDTM2	|FDTM1	|FDTM0	|FMODE	|FFVDSL	|FONSL	|ZCSL	|*/
#define         FDCNT           0xE7
/*|FLGA1|FLGA0	|FLGB1	|FLGB0	|FLGC1	|FLGC0	|FLGD1	|FLGD0	|*/
#define         FLGCNT          0xE8
/*|FDCNT7|FDCNT6|FDCNT5|FDCNT4|FDCNT3	|FDCNT2	|FDCNT1	|FDCNT0|*/
#define         FDCNTD          0xE9
/*|IOC3	|IOC2	|IOC1	|IOC0	|OUT3	|OUT2	|OUT1	|OUT0	|*/
#define         PINCNT          0xEA
/*|RMON	|SL6	|SL5	|SL4	|SL3	|SL2	|SL1	|SL0	|*/
#define         REGMON          0xEB
/*|AFCG1|AFCG0	|APCG1	|APCG0	|BKAUTO	|APCRES	|SLIO	|0 		|*/
#define         CLVCNT          0xEC
/*|X 	|CLVSP6	|CLVSP5	|CLVSP4	|CLVSP3	|CLVSP2	|CLVSP1	|CLVSP0	|*/
#define         CLVSPD          0xED
/*|LMTON|WIDON	|CKMONS|FVOSL	|FVUP	|FDSPLO	|RFOKSL	|RFDSL	|*/
#define         SREG3           0xEE
/*SVSET(EF):|SCKACC	|TMSEL2	|TMSEL1	|TMSEL0	|FOSW	|TRSW	|FDSW	|RFZCIN	|*/
#define         SVSET           0xEF


/*QDRC(00):|QDOK 	|TJ		|PB/MU	|RFOK  	|RD1~RD20 QDATA|*/
#define         QDRC            0x00
/*SRC1(01):|FOK  	|Q/R/T	|SVST1	|SVST0 	|IN3  	|IN2  	|IN1  	|IN0  	|*/
#define         SRC1            0x01
/*SRC2(02):|DATR7	|DATR6	|DATR5	|DATR4	|DATR3	|DATR2	|DATR1	|DATR0	|*/
#define         SRC2            0x02
/*SRC3(03):|PBSP7	|PBSP6	|PBSP5	|PBSP4	|PBSP3	|PBSP2	|PBSP1	|PBSP0	|*/
#define         SRC3            0x03
/*SRC4(04):|CAVCLVF 	|CHB	|PKDT5	|PKDT4	|PKDT3 	|PKDT2 	|PKDT1	|PKDT0	|*/
#define         SRC4            0x04
/*SRC5(05):|WBUSY 	|LOCK 	|FSLO	|FSPS	|PBFD3 	|PBFD2 	|PBFD1 	|PBFD0	|*/
#define         SRC5            0x05
/*SRC6(06):CTDAi*/
#define         SRC6            0x06
/*SRC6(07):CTDAi*/
#define         SRC7            0x07

#define         AFC             0x46

/*For 3721 function Down*/
/*ENHS(70h):    |FECTLS |GVSWI |TESWI | RPBWI | AWPR8E |FMMSKE | SELH |  0 |*/
#define         ENHS           0X70
/*AWPR8(71h):  |AWPR8 (7 - 0) |*/
#define         AWPR8         0X71
/*FMMSK(72h):  |FMMSKF(3 - 0) | FMMSKD (3 - 0) |*/
#define         FMMSK         0X72
/*CLMPS(73h):   |FCLMPE |TCLMPE |FCLMPS | TCLMPS | FOOS |TROS | FLGLTE |FTDETS|*/
#define         CLMPS          0X73
/*For 3721 function UP*/



/*===========================================================================
 DEFINE CONTROLLER COEFFICIENT
===========================================================================*/
#define Kt1A            0x0A
#define Kt1B            0x0B
#define Kt1C            0x2A
#define Kt1D            0x2B

#define Km10            0x3A
#define Km16            0x40

#define Kd10            0x41
#define Kd11            0x42
#define Kd12            0x43

#define PHREF           0x7E
#define SBREF           0X7C

/****************************************************
 * Read servo status               SRC1             *
 ****************************************************/
#define TRAY_IN_SW      0x04
#define TRAY_OUT_SW     0x08
#define SUBQ_READY      0x40
#define FOCUS_OK        0x80



/*===========================================================================
 * NAME:      DISC_MOTOR_STOP
 * FUNCTION:  Stop rotating disc motor.
 * POST-
 * CONDITION: Force Tracking servo to turn off.
 ===========================================================================*/

#define SERVO_CLV_STOP	{  \
                        SERVO_send_command(FTBAST,0x07);\
                        /*Choice DMO offset register*/ \
                        SERVO_send_command(DASET,0x00);\
                        SERVO_send_command(DMOFF,0x00);\
                        /*Stop rotating disc motor (CD CLV servo off)*/\
                        /*also tracking servo off*/\
                        }
#define SERVO_CLV_KICK	{ SERVO_send_command(DMFBK,0x20); kickfg = 1; }
#define SERVO_CLV_BRK	{ SERVO_send_command(DMFBK,0x10); }


#define SERVO_FOCUS_DOWN	SERVO_send_command(FORST,0x00)
/*FORST(89):| 0 |FGC|HISR|FSON| 0 |SPKSL|SPKCL|SPKST|*/
/*Push lens down.*/

#define SERVO_AUTO_FOCUS_UP	SERVO_send_command(FOSET,0x10)
#define SERVO_AUTO_FOCUS_DOWN	SERVO_send_command(FORST,0x10)
/*Do Focus search and turn on Focus servo automatically,
  if zero-cross point is found.
 COEFFICIENT:  Kf1A (Focus Search Gain, address 2Ch)
 PRECONDITION: Laser Diode ON  */
/*FOSET(88):| 0 |FGC|HISR|FSON| 0 |SPKSL|SPKCL|SPKST|*/

/* public variables */
extern char servo_seek_step;
extern char SERVO_mode;

/* public functions */
void Audio_mute_on(void);
void DISC_MOTOR_STOP(void);
void FOCUS_SERVO_OFF(void);
void PICKUP_BACKWARD(void);
void PICKUP_FORWARD(void);
void PICKUP_STOP(void);
void Reset_servo_system(void);
void TRI_ess3721_AD0();
void TRI_ess3721_AD1();
void TRI_ess3721_AD2();
void TRI_ess3721_AD3();