开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 多媒体 > DVD > 查看源码
system_servo.c
资源名称：8202s_8281s_050405_dvd_622.rar　[点击查看]
上传用户：caisangzi8
上传日期：2013-10-25
资源大小：15756k
文件大小：6k
源码类别：

DVD

开发平台：

C/C++

system_servo.c：源码内容
  1. /*
  2. *  Terry,2004/1/28 09:51AM
  3. */
  5. #ifdef SPHE8202//define 8202 SERVO TRAY SENSOR,cmchang
  6. #ifdef EMU_BOARD_256_SHARE
  7.         #define TRAY_IS_IN_GPIO 84
  8.         #define TRAY_IS_OUT_GPIO 85
  10. #elif defined(EMU_BOARD_216_PIN)
  12. #define DISC_IS_IN_GPIO 8
  13. #define TRAY_IS_IN_GPIO 9
  14. #define TRAY_IS_OUT_GPIO 10
  15. #define SRV_TRIG_GPIO 70
  16. #elif defined(EMU_BOARD_256_NON_SHARE)
  18. #elif defined(MP_BOARD_256_PIN_NON_SHARE)
  19. #ifdef PORTABLE_DVD
  20. #define TRAY_IS_IN_GPIO  6  //99 //pin232
  21. #define TRAY_IS_OUT_GPIO 18 //98 //pin231
  22. #define SRV_TRIG_GPIO 97  //pin230
  23. #else
  24. #define TRAY_IS_IN_GPIO  5
  25. #define DISC_IS_IN_GPIO 8
  26. #define TRAY_IS_OUT_GPIO 18
  27. #define SRV_TRIG_GPIO 97  //pin230
  28. #endif
  29. #elif defined(MP_BOARD_216_PIN_NON_SHARE)//kenny 2004/7/14
  30. #define TRAY_IS_IN_GPIO 70
  31. #define TRAY_IS_OUT_GPIO 71
  32. #define SRV_TRIG_GPIO 15  //pin65
  33. #elif defined(MP_BOARD_216_PIN)
  34. #define TRAY_IS_IN_GPIO 70
  35. #define TRAY_IS_OUT_GPIO 71
  37. #elif defined(MP_BOARD_256_PIN_SHARE)
  38. #define TRAY_IS_IN_GPIO 5
  39. #define TRAY_IS_OUT_GPIO 18
  42. #endif
  44. #if defined(PORTABLE_DVD)
  45. //#define LOAD_IN_GPIO 56
  46. //#define LOAD_OUT_GPIO 55
  47. #define DISC_IS_IN_GPIO 55  //100
  48. #endif
  50. //#else //define 8200 SERVO TRIGER GPIO
  51. //#define SRV_TRIG_GPIO 14
  52. #endif
  55. static inline void system_init_servo_var(void)
  56. {
  57. #ifdef DVD_SERVO
  58. #ifdef PREAMP_GPIO_ENABLE
  59. gbSrvFuncSW = 0x01;
  60. #else
  61. gbSrvFuncSW = 0x00;
  62. #endif
  64. #ifdef TRAY_AVAILABLE
  65. gbSrvFuncSW |= 0x02;
  66. #endif
  67. #ifdef DISC_TYPE_RETRY
  68. gbSrvFuncSW |= 0x04;
  69. #endif
  70. #ifdef CHANGE_TRAY_DIRECTION_FUNC
  71. gbSrvFuncSW |= 0x08;
  72. #endif
  73. #ifdef POWER_ON_TOPDOOR_PRESTOP
  74. gbSrvFuncSW |= 0x10;
  75. #endif
  76. #ifdef POWER_ON_SERVO_STARTUP
  77. gbSrvFuncSW |= 0x20;
  78. #endif
  79. #ifdef PH0PH0_STD
  80. gbSrvFuncSW |= 0x40;
  81. #endif
  83. #ifdef NEW_DEBOUNCE_COUNTER
  84. gbDebounce = NEW_DEBOUNCE_COUNTER;
  85. #endif
  87. // SERVO Eject Speed
  88. #ifdef TRAY_SPEED
  89. gbEjectSpeed = TRAY_SPEED;
  90. #endif
  92. #ifdef TRAY_OUT_SPEED1
  93. gbEjectSpeed1 = TRAY_OUT_SPEED1;
  94. #endif
  96. #ifdef TRAY_OUT_SPEED2
  97. gbEjectSpeed2 = TRAY_OUT_SPEED2;
  98. #endif
  100. #ifdef TRAY_IN_SPEED1
  101. gbEjectSpeed3 = TRAY_IN_SPEED1;
  102. #endif
  104. #ifdef TRAY_IN_SPEED2
  105. gbEjectSpeed4 = TRAY_IN_SPEED2;
  106. #endif
  108. #ifdef TRAY_OUT_CNT
  109. gbTray_Out_Cnt = TRAY_OUT_CNT;
  110. #endif
  112. #ifdef TRAY_IN_CNT
  113. gbTray_In_Cnt = TRAY_IN_CNT;
  114. #endif
  116. #ifdef TRAY_OUT_BRAKE_TIMER
  117. gbTrayOutBrakeTimer=TRAY_OUT_BRAKE_TIMER;
  118. #endif
  120. // 8202 SERVO TRAY Sensor,cmchang
  121. #ifdef TRAY_IS_IN_GPIO
  122.     gbGPIO_TrayIsIn = TRAY_IS_IN_GPIO;
  123. #endif
  124. #ifdef TRAY_IS_OUT_GPIO
  125.     gbGPIO_TrayIsOut = TRAY_IS_OUT_GPIO;
  126. #endif
  127. #ifdef DISC_IS_IN_GPIO
  128.     gbGPIO_DiscIsIn = DISC_IS_IN_GPIO;
  129. #endif
  131. #ifdef DISC_IS_STANDBY_GPIO
  132.     gbGPIO_TrayIsMid = DISC_IS_STANDBY_GPIO;
  133. #endif
  135. #ifdef SLED_IS_OUT_GPIO
  136.     gbGPIO_SledIsOut = SLED_IS_OUT_GPIO;
  137. #endif
  139. // 8202 SERVO DeBUG LED2, longson
  140. #ifdef SRV_TRIG_GPIO
  141. gbGPIO_TrigLED1 = SRV_TRIG_GPIO;
  142. #endif
  144. #endif
  146. // 8202 SERVO LOAD IN/OUT GPIO  2004/07/20/hcchang
  147. #ifdef LOAD_IN_GPIO
  148.     gbGPIO_LoadIn = LOAD_IN_GPIO;
  149. #endif
  150. #ifdef LOAD_OUT_GPIO
  151.     gbGPIO_LoadOut = LOAD_OUT_GPIO;
  152. #endif
  154. // 8202 Servo Table
  155. #ifdef SPHE8202
  156. extern BYTE (*_gpbEQSetting)[4];
  157. #ifdef IC_8202D
  158. extern BYTE _gpbEQ_PS2P5[][4];
  159. _gpbEQSetting = _gpbEQ_PS2P5;
  160. #elif defined(IC_8202E)
  161. extern BYTE _gpbEQ_PJ8202A[][4];
  162. _gpbEQSetting = _gpbEQ_PJ8202A;
  163. #else
  164. if (regs0->stamp==0x82) // PS2.1
  165. {
  166. extern BYTE _gpbEQ_PS2P1[][4];
  167. _gpbEQSetting = _gpbEQ_PS2P1;
  168. }
  169. else // PA8202
  170. {
  171. extern BYTE _gpbEQ_PA8202[][4];
  172. _gpbEQSetting = _gpbEQ_PA8202;
  173. }
  174. #endif
  175. #endif
  177. //------------------Slot-in--------------//TEAC
  178. #ifdef TEAC_PORTABLE_DVD
  179. gbGPIO_TrayIsMid = GPIO_SW_A;
  180. gbGPIO_TrayIsIn  = GPIO_LDCMPLT;
  181. gbGPIO_TrayIsOut = GPIO_EJCMPLT;
  182. gbGPIO_DiscIsIn  = GPIO_PRELOAD;
  183. gbGPIO_SledIsOut = GPIO_OUT_SW;
  184. #endif
  185. //---------------------------------------
  187. }
  189. // SERVO_LIGHT hcchang
  190. // 2005/04/03 yltseng, to eliminate warning message
  191. UCHAR DecFunctionNull() {return 0;}
  193. #ifdef SUPPORT_CD_TEXT
  194. extern void CheckCDText_(void);
  195. extern void InitCDText_(void);
  196. extern void ReadCDText_(void);
  197. void (* CheckCDText)() = CheckCDText_;
  198. void (* InitCDText)() = InitCDText_;
  199. void (* ReadCDText)() = ReadCDText_;
  200. #else
  201. void (* CheckCDText)() = (void *)DecFunctionNull;
  202. void (* InitCDText)() = (void *)DecFunctionNull;
  203. void (* ReadCDText)() = (void *)DecFunctionNull;
  204. #endif
  206. #if defined(SUPPORT_CDG) && !defined(SUPPORT_ECC)
  207. extern UCHAR CDSubCodeProc_(void);
  208. extern void CDSubCodeBackUp_(void);
  209. extern void CDSubCodeECCInit_(void);
  210. extern void CDSubCodeECCClear_(void);
  211. UCHAR (* CDSubCodeProc)()       = CDSubCodeProc_;
  212. void (* CDSubCodeBackUp)()      = CDSubCodeBackUp_;
  213. void (* CDSubCodeECCInit)()     = CDSubCodeECCInit_;
  214. void (* CDSubCodeECCClear)()    = CDSubCodeECCClear_;
  215. #else
  216. UCHAR (* CDSubCodeProc)()       = DecFunctionNull;
  217. void (* CDSubCodeBackUp)()      = (void(*)())DecFunctionNull;
  218. void (* CDSubCodeECCInit)()     = (void(*)())DecFunctionNull;
  219. void (* CDSubCodeECCClear)()    = (void(*)())DecFunctionNull;
  220. #endif
  222. #ifdef SERVO_LIGHT
  223. UCHAR (* DecOptionalFunc1)()    = DecFunctionNull;
  224. void (* DecOptionalFunc2)()     = (void(*)())DecFunctionNull;
  225. void (* DecOptionalFunc3)()     = (void(*)())DecFunctionNull;
  226. void (* DecOptionalFunc4)()     = (void(*)())DecFunctionNull;
  227. void (* DecOptionalFunc5)()     = (void(*)())DecFunctionNull;
  228. void (* DecOptionalFunc6)()     = (void(*)())DecFunctionNull;
  230. #else
  231. extern UCHAR DecOptionalFunc1a();
  232. extern void DecOptionalFunc2a();
  233. extern void DecOptionalFunc3a();
  234. extern void DecOptionalFunc4a();
  235. extern void DecOptionalFunc5a();
  236. extern void DecOptionalFunc6a();
  238. UCHAR (* DecOptionalFunc1)()    = DecOptionalFunc1a;
  239. void (* DecOptionalFunc2)()     = DecOptionalFunc2a;
  240. void (* DecOptionalFunc3)()     = DecOptionalFunc3a;
  241. void (* DecOptionalFunc4)()     = DecOptionalFunc4a;
  242. void (* DecOptionalFunc5)()     = DecOptionalFunc5a;
  243. void (* DecOptionalFunc6)()     = DecOptionalFunc6a;
  244. #endif
  246. //-----------------------------------------ending----------------------------------------------