forked from 3drobotics/solo-esc-simonk
-
Notifications
You must be signed in to change notification settings - Fork 4
/
afro2.inc
83 lines (70 loc) · 1.77 KB
/
afro2.inc
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
;***********************************************************
;* AfroESC 2 *
;* 2012.02 *
;***********************************************************
.equ F_CPU = 16000000
.equ USE_INT0 = 0
.equ USE_I2C = 1
.equ USE_UART = 1
.equ USE_ICP = 1
.equ DEAD_LOW_NS = 2200
.equ DEAD_HIGH_NS = 24000
;*********************
; PORT B definitions *
;*********************
;.equ = 7
;.equ = 6
;.equ = 5 (sck)
;.equ = 4 (miso)
;.equ = 3 (mosi)
.equ BpFET = 2 ;o
.equ CpFET = 1 ;o
.equ rcp_in = 0 ;i r/c pulse input
.equ INIT_PB = 0
.equ DIR_PB = (1<<BpFET)+(1<<CpFET)
.equ BpFET_port = PORTB
.equ CpFET_port = PORTB
;*********************
; PORT C definitions *
;*********************
.equ mux_voltage = 7 ; ADC7 voltage input
;.equ = 6 ; ADC6
.equ i2c_clk = 5 ; ADC5/SCL
.equ i2c_data = 4 ; ADC4/SDA
.equ ApFET = 3 ; o
.equ StatLED = 2 ; o
.equ mux_b = 1 ; ADC1 phase input
.equ mux_a = 0 ; ADC0 phase input
.equ O_POWER = 18
.equ O_GROUND = 1
.equ INIT_PC = (1<<i2c_clk)+(1<<i2c_data)
.equ DIR_PC = (1<<ApFET)+(1<<StatLED)
.equ ApFET_port = PORTC
;*********************
; PORT D definitions *
;*********************
;.equ mux_c = 7 (comparator AN1)
;.equ = 6 (comparator AN0)
.equ CnFET = 5
.equ BnFET = 4
.equ AnFET = 3
.equ WarnLED = 2
;.equ = 1
;.equ = 0 USART_RX
.equ INIT_PD = 0
.equ DIR_PD = (1<<AnFET)+(1<<BnFET)+(1<<CnFET)+(1<<WarnLED)
.equ AnFET_port = PORTD
.equ BnFET_port = PORTD
.equ CnFET_port = PORTD
.MACRO RED_on
sbi PORTD, WarnLED
.ENDMACRO
.MACRO RED_off
cbi PORTD, WarnLED
.ENDMACRO
.MACRO GRN_on
sbi PORTC, StatLED
.ENDMACRO
.MACRO GRN_off
cbi PORTC, StatLED
.ENDMACRO