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

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

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_PS2P1[][4];
  159. _gpbEQSetting = _gpbEQ_PS2P1;
  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. UCHAR DecFunctionNull() {return 0;}
  192. #ifdef SERVO_LIGHT
  193. UCHAR (* DecOptionalFunc1)() = DecFunctionNull;
  194. void (* DecOptionalFunc2)() = DecFunctionNull;
  195. void (* DecOptionalFunc3)() = DecFunctionNull;
  196. void (* DecOptionalFunc4)() = DecFunctionNull;
  197. void (* DecOptionalFunc5)() = DecFunctionNull;
  198. void (* DecOptionalFunc6)() = DecFunctionNull;
  200. #else
  201. extern UCHAR DecOptionalFunc1a();
  202. extern void DecOptionalFunc2a();
  203. extern void DecOptionalFunc3a();
  204. extern void DecOptionalFunc4a();
  205. extern void DecOptionalFunc5a();
  206. extern void DecOptionalFunc6a();
  208. UCHAR (* DecOptionalFunc1)() = DecOptionalFunc1a;
  209. void (* DecOptionalFunc2)() = DecOptionalFunc2a;
  210. void (* DecOptionalFunc3)() = DecOptionalFunc3a;
  211. void (* DecOptionalFunc4)() = DecOptionalFunc4a;
  212. void (* DecOptionalFunc5)() = DecOptionalFunc5a;
  213. void (* DecOptionalFunc6)() = DecOptionalFunc6a;
  214. #endif
  216. //-----------------------------------------ending----------------------------------------------