You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

289 lines
7.5 KiB

12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
12 years ago
  1. ;**** **** **** **** ****
  2. ;
  3. ; BLHeli program for controlling brushless motors in helicopters and multirotors
  4. ;
  5. ; Copyright 2011, 2012 Steffen Skaug
  6. ; This program is distributed under the terms of the GNU General Public License
  7. ;
  8. ; This file is part of BLHeli.
  9. ;
  10. ; BLHeli is free software: you can redistribute it and/or modify
  11. ; it under the terms of the GNU General Public License as published by
  12. ; the Free Software Foundation, either version 3 of the License, or
  13. ; (at your option) any later version.
  14. ;
  15. ; BLHeli is distributed in the hope that it will be useful,
  16. ; but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. ; GNU General Public License for more details.
  19. ;
  20. ; You should have received a copy of the GNU General Public License
  21. ; along with BLHeli. If not, see <http://www.gnu.org/licenses/>.
  22. ;
  23. ;**** **** **** **** ****
  24. ;
  25. ; Align RCE-BL35X 35A hardware definition file
  26. ;
  27. ;**** **** **** **** ****
  28. ;*********************
  29. ; Device SiLabs F330
  30. ;*********************
  31. $include (c8051f330.inc)
  32. ;**** **** **** **** ****
  33. ; Uses internal calibrated oscillator set to 24Mhz
  34. ;**** **** **** **** ****
  35. ;**** **** **** **** ****
  36. ; Constant definitions
  37. ;**** **** **** **** ****
  38. CSEG AT 1A40h
  39. Eep_ESC_Layout: DB "#AlignBL35X# " ; ESC layout tag
  40. CSEG AT 1A50h
  41. Eep_ESC_MCU: DB "#BLHELI#F330# " ; Project and MCU tag (16 Bytes)
  42. MCU_48MHZ EQU 0 ; Set to 1 if MCU can run at 48MHz
  43. ONE_S_CAPABLE EQU 0 ; Set to 1 if ESC can operate at 1S
  44. PORT3_EXIST EQU 0 ; Set to 1 if MCU has port3
  45. COMP1_USED EQU 0 ; Set to 1 if MCU has comparator 1 and it is being used
  46. LOCK_BYTE_ADDRESS_16K EQU 3FFFh ; Address of lock byte if 16k flash size
  47. LOCK_BYTE_ADDRESS_8K EQU 1DFFh ; Address of lock byte if 8k flash size
  48. HIGH_BEC_VOLTAGE EQU 0 ; Set to 1 or more if high BEC voltage is supported
  49. DAMPED_MODE_ENABLE EQU 1 ; Damped mode disabled
  50. NFETON_DELAY EQU 8 ; Wait delay from pfets off to nfets on
  51. PFETON_DELAY EQU 12 ; Wait delay from nfets off to pfets on
  52. ADC_LIMIT_L EQU 85 ; Power supply measurement ADC value for which main motor power is limited (low byte)
  53. ADC_LIMIT_H EQU 0 ; Power supply measurement ADC value for which main motor power is limited (2 MSBs)
  54. TEMP_LIMIT EQU 109 ; Temperature measurement ADC value for which main motor power is limited (low byte, assuming high byte is 1)
  55. TEMP_LIMIT_STEP EQU 4 ; Temperature measurement ADC value increment for which main motor power is further limited
  56. ;**** **** **** **** ****
  57. ; ESC specific defaults
  58. ;**** **** **** **** ****
  59. DEFAULT_PGM_MAIN_SPOOLUP_TIME EQU 10 ; Main motor spoolup time
  60. DEFAULT_PGM_MAIN_STARTUP_PWR EQU 9 ; 1=0.031 2=0.047 3=0.063 4=0.094 5=0.125 6=0.188 7=0.25 8=0.38 9=0.50 10=0.75 11=1.00 12=1.25 13=1.50
  61. DEFAULT_PGM_TAIL_STARTUP_PWR EQU 9 ; 1=0.031 2=0.047 3=0.063 4=0.094 5=0.125 6=0.188 7=0.25 8=0.38 9=0.50 10=0.75 11=1.00 12=1.25 13=1.50
  62. DEFAULT_PGM_MULTI_STARTUP_PWR EQU 9 ; 1=0.031 2=0.047 3=0.063 4=0.094 5=0.125 6=0.188 7=0.25 8=0.38 9=0.50 10=0.75 11=1.00 12=1.25 13=1.50
  63. ;**** **** **** **** ****
  64. ; Bootloader definitions
  65. ;**** **** **** **** ****
  66. RTX_PORT EQU P0 ; Receive/Transmit port
  67. RTX_MDOUT EQU P0MDOUT ; Set to 1 for PUSHPULL
  68. RTX_MDIN EQU P0MDIN ; Set to 1 for DIGITAL
  69. RTX_SKIP EQU P0SKIP ; Set to 1 for SKIP
  70. RTX_PIN EQU 5 ; RTX pin
  71. SIGNATURE_001 EQU 0f3h ; Device signature
  72. SIGNATURE_002 EQU 030h
  73. ;*********************
  74. ; PORT 0 definitions *
  75. ;*********************
  76. Mux_A EQU 7 ;i
  77. Comp_ComA EQU 6 ;i
  78. Rcp_In EQU 5 ;i
  79. ; EQU 4 ;i
  80. AnFET EQU 3 ;o
  81. BpFET EQU 2 ;o
  82. ; EQU 1 ;i
  83. ApFET EQU 0 ;o
  84. P0_DIGITAL EQU NOT((1 SHL Mux_A)+(1 SHL Comp_ComA)) AND 0FFh
  85. P0_INIT EQU NOT((1 SHL AnFET)+(1 SHL ApFET)+(1 SHL BpFET)) AND 0FFh
  86. P0_PUSHPULL EQU (1 SHL AnFET)+(1 SHL ApFET)+(1 SHL BpFET)
  87. P0_SKIP EQU NOT(1 SHL Rcp_In)
  88. MACRO Get_Rcp_Capture_Values
  89. mov Temp1, PCA0CPL0 ; Get PCA capture values
  90. mov Temp2, PCA0CPH0
  91. ENDM
  92. MACRO Read_Rcp_Int
  93. mov A, P0
  94. jnb Flags3.PGM_RCP_PWM_POL, ($+4) ; Is pwm polarity negative?
  95. cpl A ; Yes - invert
  96. ENDM
  97. MACRO Rcp_Int_Enable
  98. orl PCA0CPM0, #01h ; Interrupt enabled
  99. ENDM
  100. MACRO Rcp_Int_Disable
  101. anl PCA0CPM0, #0FEh ; Interrupt disabled
  102. ENDM
  103. MACRO Rcp_Int_First
  104. anl PCA0CPM0, #0CFh
  105. jb Flags3.PGM_RCP_PWM_POL, ($+6) ; Is pwm polarity positive?
  106. orl PCA0CPM0, #20h ; Capture rising edge
  107. jnb Flags3.PGM_RCP_PWM_POL, ($+6) ; Is pwm polarity negative?
  108. orl PCA0CPM0, #10h ; Capture falling edge
  109. ENDM
  110. MACRO Rcp_Int_Second
  111. anl PCA0CPM0, #0CFh
  112. jb Flags3.PGM_RCP_PWM_POL, ($+6) ; Is pwm polarity positive?
  113. orl PCA0CPM0, #10h ; Capture falling edge
  114. jnb Flags3.PGM_RCP_PWM_POL, ($+6) ; Is pwm polarity negative?
  115. orl PCA0CPM0, #20h ; Capture rising edge
  116. ENDM
  117. MACRO Rcp_Clear_Int_Flag
  118. clr CCF0 ; Clear interrupt flag
  119. ENDM
  120. ;*********************
  121. ; PORT 1 definitions *
  122. ;*********************
  123. CpFET EQU 7 ;o
  124. ; EQU 6 ;i
  125. CnFET EQU 5 ;o
  126. BnFET EQU 4 ;o
  127. Mux_C EQU 3 ;i
  128. Comp_ComC EQU 2 ;i
  129. Mux_B EQU 1 ;i
  130. Comp_ComB EQU 0 ;i
  131. P1_DIGITAL EQU NOT((1 SHL Mux_B)+(1 SHL Mux_C)+(1 SHL Comp_ComB)+(1 SHL Comp_ComC)) AND 0FFh
  132. P1_INIT EQU NOT((1 SHL BnFET)+(1 SHL CnFET)+(1 SHL CpFET)) AND 0FFh
  133. P1_PUSHPULL EQU (1 SHL BnFET)+(1 SHL CnFET)+(1 SHL CpFET)
  134. P1_SKIP EQU 0
  135. MACRO AnFET_on
  136. setb P0.AnFET
  137. ENDM
  138. MACRO AnFET_off
  139. clr P0.AnFET
  140. ENDM
  141. MACRO BnFET_on
  142. setb P1.BnFET
  143. ENDM
  144. MACRO BnFET_off
  145. clr P1.BnFET
  146. ENDM
  147. MACRO CnFET_on
  148. setb P1.CnFET
  149. ENDM
  150. MACRO CnFET_off
  151. clr P1.CnFET
  152. ENDM
  153. MACRO All_nFETs_Off
  154. clr P0.AnFET
  155. clr P1.BnFET
  156. clr P1.CnFET
  157. ENDM
  158. MACRO ApFET_on
  159. setb P0.ApFET
  160. ENDM
  161. MACRO ApFET_off
  162. clr P0.ApFET
  163. ENDM
  164. MACRO BpFET_on
  165. setb P0.BpFET
  166. ENDM
  167. MACRO BpFET_off
  168. clr P0.BpFET
  169. ENDM
  170. MACRO CpFET_on
  171. setb P1.CpFET
  172. ENDM
  173. MACRO CpFET_off
  174. clr P1.CpFET
  175. ENDM
  176. MACRO All_pFETs_On
  177. setb P0.ApFET
  178. setb P0.BpFET
  179. setb P1.CpFET
  180. ENDM
  181. MACRO All_pFETs_Off
  182. clr P0.ApFET
  183. clr P0.BpFET
  184. clr P1.CpFET
  185. ENDM
  186. MACRO Damping_FET_On
  187. mov A, DampingFET
  188. cjne A, CpFET, damp_on_ab
  189. orl P1, A
  190. ajmp damp_on_exit
  191. damp_on_ab:
  192. orl P0, A
  193. damp_on_exit:
  194. ENDM
  195. MACRO Set_Comp_Phase_A
  196. mov CPT0MX, #33h ; Set comparator multiplexer to phase A
  197. ENDM
  198. MACRO Set_Comp_Phase_B
  199. mov CPT0MX, #43h ; Set comparator multiplexer to phase B
  200. ENDM
  201. MACRO Set_Comp_Phase_C
  202. mov CPT0MX, #53h ; Set comparator multiplexer to phase C
  203. ENDM
  204. MACRO Read_Comp_Out
  205. mov A, CPT0CN ; Read comparator output
  206. cpl A ; Invert output
  207. ENDM
  208. ;*********************
  209. ; PORT 2 definitions *
  210. ;*********************
  211. DebugPin EQU 0 ;o
  212. P2_PUSHPULL EQU (1 SHL DebugPin)
  213. ;**********************
  214. ; MCU specific macros *
  215. ;**********************
  216. MACRO Interrupt_Table_Definition
  217. CSEG AT 0 ; Code segment start
  218. jmp reset
  219. CSEG AT 0Bh ; Timer0 interrupt
  220. jmp t0_int
  221. CSEG AT 2Bh ; Timer2 interrupt
  222. jmp t2_int
  223. CSEG AT 5Bh ; PCA interrupt
  224. jmp pca_int
  225. CSEG AT 73h ; Timer3 interrupt
  226. jmp t3_int
  227. ENDM
  228. MACRO Initialize_Xbar
  229. mov XBR1, #41h ; Xbar enabled, CEX0 routed to pin Rcp_In
  230. ENDM
  231. MACRO Initialize_Adc
  232. mov REF0CN, #0Eh ; Set vdd (3.3V) as reference. Enable temp sensor and bias
  233. mov ADC0CF, #58h ; ADC clock 2MHz
  234. mov AMX0P, #(8+Mux_B) ; Select positive input (use comparator input B)
  235. mov AMX0N, #11h ; Select negative input as ground
  236. mov ADC0CN, #80h ; ADC enabled
  237. ENDM
  238. MACRO Set_Adc_Ip_Volt
  239. mov AMX0P, #(8+Mux_B) ; Select positive input (use comparator input B)
  240. ENDM
  241. MACRO Set_Adc_Ip_Temp
  242. mov AMX0P, #10h ; Select temp sensor input
  243. ENDM
  244. MACRO Start_Adc
  245. mov ADC0CN, #90h ; ADC start
  246. ENDM
  247. MACRO Get_Adc_Status
  248. mov A, ADC0CN
  249. ENDM
  250. MACRO Read_Adc_Result
  251. mov Temp1, ADC0L
  252. mov Temp2, ADC0H
  253. ENDM
  254. MACRO Stop_Adc
  255. ENDM
  256. MACRO Set_RPM_Out
  257. ENDM
  258. MACRO Clear_RPM_Out
  259. ENDM
  260. MACRO Set_MCU_Clk_24MHz
  261. ENDM
  262. MACRO Set_MCU_Clk_48MHz
  263. ENDM