;===========================================================================================
JMP L7F00 ;0002 E154 7F00
;===========================================================================================
JSR $85E0 ;0004 E254 85E0
MOVE.W #$00,X:COP_CTRL ;0006 E680 F120
MOVE.W #>$F000,X:COP_TOUT ;0008 8654 F121 F000
BFSET #$02,X:>COP_CTRL ;000B 8254 F120 0002
JSR $8690 ;000E E254 8690
MOVEU.W #$500,R0 ;0010 8748 0500
MOVE.W R0,A ;0012 8008
BFSET #$01,X:>$02 ;0013 8254 0002 0001
MOVE.W A1,X:>$109 ;0016 D07C 0109
L0018: MOVE.W #>$5555,X:COP_CNTR ;0018 8654 F122 5555
MOVE.W #>$AAAA,X:COP_CNTR ;001B 8654 F122 AAAA
JSR $84FA ;001E E254 84FA
JSR $86B4 ;0020 E254 86B4
JSR $8765 ;0022 E254 8765
MOVEU.BP X:$215,A ;0024 F8FD 0215
BRCLR #$10,A1,L0018 ;0026 8B50 1070
NOP ;0028 E700
NOP ;0029 E700
BRCLR #$04,A1,L0018 ;002A 8B50 046C
NOP ;002C E700
NOP ;002D E700
BRSET #$02,A1,L0038 ;002E 8F50 0208
BFCLR #$01,X:>I2C_ENBL ;0030 8054 F2B6 0001
JSR $8612 ;0033 E254 8612
BFSET #$01,X:>I2C_ENBL ;0035 8254 F2B6 0001
L0038: JSR $862E ;0038 E254 862E
BRA L0018 ;003A A95D
;===========================================================================================
L0003B: MOVEU.BP X:$23A,A ;003B F8FD 023A
CMP.B #$7E,A ;003D 5C42 007E
BNE L004A ;003F A20A
MOVE.BP X:$06,X:$21A ;0040 F6FD 0006 021A
MOVE.W #$01,A ;0043 E081
MOVE.BP A1,X:$217 ;0044 D0FD 0217
CLR.BP X:$06 ;0046 D9FD 0006
BRA >L00A7 ;0048 E16C 005E
;===========================================================================================
L004A: CMP.B #$9A,A ;004A 5C42 009A
BNE L005D ;004C A210
MOVEU.W #$FFC0,R2 ;004D 874A FFC0
MOVEU.W #$21A,R3 ;004F 874B 021A
LSRA R2 ;0051 8536
MOVE.W #$08,Y0 ;0052 E588
MOVE.W #$01,Y1 ;0053 E781
JSR $85FD ;0054 E254 85FD
MOVEU.BP X:$21A,A ;0056 F8FD 021A
ADD.W #$01,A ;0058 4401
MOVE.BP A1,X:$217 ;0059 D0FD 0217
BRA >L00A7 ;005B E16C 004B
;===========================================================================================
L005D: CMP.B #$F3,A ;005D 5C42 00F3
BNE L006B ;005F A20B
MOVE.W X:>$02,A ;0060 F07C 0002
MOVE.BP A1,X:$21A ;0062 D0FD 021A
LSRR.W #$08,A ;0064 5C28
MOVE.BP A1,X:$21B ;0065 D0FD 021B
MOVE.W #$02,A ;0067 E082
MOVE.BP A1,X:$217 ;0068 D0FD 0217
BRA L00A7 ;006A A93C
;===========================================================================================
L006B: CMP.B #$F4,A ;006B 5C42 00F4
BNE L0079 ;006D A20B
MOVE.W X:>$109,A ;006E F07C 0109
MOVE.BP A1,X:$21A ;0070 D0FD 021A
LSRR.W #$08,A ;0072 5C28
MOVE.BP A1,X:$21B ;0073 D0FD 021B
MOVE.W #$02,A ;0075 E082
MOVE.BP A1,X:$217 ;0076 D0FD 0217
BRA L00A7 ;0078 A92E
;===========================================================================================
L0079: CMP.B #$F5,A ;0079 5C42 00F5
BNE L0090 ;007B A214
NOP ;007C E700
MOVE.W #$10,A ;007D E090
MOVE.BP A1,X:$21A ;007E D0FD 021A
MOVE.W X:>$109,A ;0080 F07C 0109
MOVEU.W #$21B,R3 ;0082 874B 021B
MOVEU.W A1,R2 ;0084 8A10
MOVE.W #$08,Y0 ;0085 E588
MOVE.W #$00,Y1 ;0086 E780
JSR $85FD ;0087 E254 85FD
MOVE.W #$08,A ;0089 E088
ADD.W A,X:$109 ;008A 7457 0109
MOVE.W #$11,A ;008C E091
MOVE.BP A1,X:$217 ;008D D0FD 0217
BRA L00A7 ;008F A917
;===========================================================================================
L0090: CMP.B #$E1,A ;0090 5C42 00E1
BNE L00A3 ;0092 A210
MOVEU.W #$EDF2,R2 ;0093 874A EDF2
MOVE.W #$08,A ;0095 E088
MOVEU.W #$21B,R3 ;0096 874B 021B
LSRA R2 ;0098 8536
MOVE.W #$04,Y0 ;0099 E584
MOVE.W #$01,Y1 ;009A E781
MOVE.BP A1,X:$21A ;009B D0FD 021A
JSR $85FD ;009D E254 85FD
MOVE.W #$09,A ;009F E089
MOVE.BP A1,X:$217 ;00A0 D0FD 0217
BRA L00A7 ;00A2 A904
;===========================================================================================
L00A3: MOVE.W #>$80,A ;00A3 8740 0080
MOVE.BP A1,X:$06 ;00A5 D0FD 0006
L00A7: RTS ;00A7 E708
;===========================================================================================
L000A8: ADDA #$02,SP ;00A8 827B
ASLA SP,R3 ;00A9 80B7
MOVEU.W #$214,R2 ;00AA 874A 0214
ADDA #$00,R3,R3 ;00AC 8237 0000
MOVE.W #$01,Y0 ;00AE E581
MOVE.W #$00,Y1 ;00AF E780
JSR $848C ;00B0 E254 848C
ASLA SP,R3 ;00B2 80B7
MOVEU.BP X:$219,Y0 ;00B3 FDFD 0219
MOVEU.W #$23A,R2 ;00B5 874A 023A
ADDA #-$01,R3,R3 ;00B7 8A37 FFFF
MOVEU.B X:(SP),Y1 ;00B9 FFBF
JSR $848C ;00BA E254 848C
MOVEU.BP X:$23A,A ;00BC F8FD 023A
CMP.B #$F2,A ;00BE 5C42 00F2
BNE L00D9 ;00C0 A218
MOVEU.BP X:$219,A ;00C1 F8FD 0219
CMP.B #$03,A ;00C3 5423
BNE L00C8 ;00C4 A203
TST.B X:(SP-$01) ;00C5 D8EB FFFF
BEQ L00CB ;00C7 A303
L00C8: NOP ;00C8 E700
CMP.B #$02,A ;00C9 5422
BNE L00CF ;00CA A204
L00CB: JSR $840E ;00CB E254 840E
BRA >L0110 ;00CD E16C 0042
;===========================================================================================
L00CF: CMP.B #$03,A ;00CF 5423
BCS L0110 ;00D0 A13F
TST.B X:(SP-$01) ;00D1 D8EB FFFF
BEQ L0110 ;00D3 A33C
NOP ;00D4 E700
MOVE.W #$20,A ;00D5 E0A0
MOVE.BP A1,X:$06 ;00D6 D0FD 0006
BRA L0110 ;00D8 A937
;===========================================================================================
L00D9: CMP.B #$F4,A ;00D9 5C42 00F4
BNE L00F3 ;00DB A217
MOVEU.BP X:$219,A ;00DC F8FD 0219
CMP.B #$04,A ;00DE 5424
BNE L00E3 ;00DF A203
TST.B X:(SP-$01) ;00E0 D8EB FFFF
BEQ L00E6 ;00E2 A303
L00E3: NOP ;00E3 E700
CMP.B #$03,A ;00E4 5423
BNE L00E9 ;00E5 A203
L00E6: JSR $8433 ;00E6 E254 8433
BRA L0110 ;00E8 A927
;===========================================================================================
L00E9: CMP.B #$04,A ;00E9 5424
BCS L0110 ;00EA A125
TST.B X:(SP-$01) ;00EB D8EB FFFF
BEQ L0110 ;00ED A322
NOP ;00EE E700
MOVE.W #$20,A ;00EF E0A0
MOVE.BP A1,X:$06 ;00F0 D0FD 0006
BRA L0110 ;00F2 A91D
;===========================================================================================
L00F3: CMP.B #$F5,A ;00F3 5C42 00F5
BNE L0110 ;00F5 A21A
MOVEU.BP X:$219,A ;00F6 F8FD 0219
CMP.B #$13,A ;00F8 5433
BNE L00FD ;00F9 A203
TST.B X:(SP-$01) ;00FA D8EB FFFF
BEQ L0100 ;00FC A303
L00FD: NOP ;00FD E700
CMP.B #$12,A ;00FE 5432
BNE L0103 ;00FF A203
L0100: JSR $85CB ;0100 E254 85CB
BRA L0110 ;0102 A90D
;===========================================================================================
L0103: CMP.B #$13,A ;0103 5433
BCS L010D ;0104 A108
TST.B X:(SP-$01) ;0105 D8EB FFFF
BEQ L010D ;0107 A305
NOP ;0108 E700
MOVE.W #$20,A ;0109 E0A0
MOVE.BP A1,X:$06 ;010A D0FD 0006
BRA L0110 ;010C A903
;===========================================================================================
L010D: BFSET #$10,X:>$02 ;010D 8254 0002 0010
L0110: SUBA #$02,SP ;0110 9F7E
RTS ;0111 E708
;===========================================================================================
L000112: MOVEU.BP X:$23B,A ;0112 F8FD 023B
CMP.B #$03,A ;0114 5423
BNE L011C ;0115 A206
MOVE.W #$00,X:$02 ;0116 E680 0002
BFSET #$01,X:>$02 ;0118 8254 0002 0001
BRA L0136 ;011B A91A
;===========================================================================================
L011C: CMP.B #$02,A ;011C 5422
BNE L0132 ;011D A214
MOVEU.W #$500,R0 ;011E 8748 0500
MOVE.W R0,A ;0120 8008
MOVEU.W #$02,R0 ;0121 8748 0002
BFCLR #$10,X:(R0) ;0123 8040 0010
BFCLR #$600,X:>$10A ;0125 8054 010A 0600
BFCLR #$08,X:(R0) ;0128 8040 0008
BFSET #$1000,X:>$10A ;012A 8254 010A 1000
MOVE.W A1,X:>$109 ;012D D07C 0109
BFCLR #$02,X:(R0) ;012F 8040 0002
BRA L0136 ;0131 A904
;===========================================================================================
L0132: TST.B A ;0132 7023
BNE L0136 ;0133 A202
JSR $843F ;0134 E254 843F
L0136: RTS ;0136 E708
;===========================================================================================
L000137: MOVEU.BP X:$23C,Y0 ;0137 FDFD 023C
MOVEU.BP X:$23B,B ;0139 F9FD 023B
MOVE.W #>$F0,A ;013B 8740 00F0
ASLL.W #$08,Y0 ;013D 5EF8
AND.W B,A ;013E 7818
OR.W Y0,A ;013F 7859
MOVE.W A1,X:>$109 ;0140 D07C 0109
RTS ;0142 E708
;===========================================================================================
L000143: JSR $84E7 ;0143 E254 84E7
TST.B Y0 ;0145 72A3
BEQ L014C ;0146 A305
BFSET #$02,X:>$02 ;0147 8254 0002 0002
BRA >L018F ;014A E16C 0044
;===========================================================================================
L014C: BFCLR #$04,X:>$02 ;014C 8054 0002 0004
BRSET #$08,X:>$02,L018F ;014F 8E54 0002 083D
NOP ;0152 E700
NOP ;0153 E700
BRSET #$10,X:>$02,L018F ;0154 8E54 0002 1038
NOP ;0157 E700
NOP ;0158 E700
BRSET #$02,X:>$02,L018F ;0159 8E54 0002 0233
MOVEU.W #$7E00,R0 ;015C 8748 7E00
MOVE.W R0,A ;015E 8008
MOVEU.W #$12,R3 ;015F 874B 0012
MOVE.W #>$100,Y0 ;0161 8745 0100
MOVEU.W A1,R2 ;0163 8A10
MOVE.W #$01,Y1 ;0164 E781
JSR $85FD ;0165 E254 85FD
MOVEU.W #$7E00,R0 ;0167 8748 7E00
MOVE.W R0,A ;0169 8008
MOVE.W #>$40,Y0 ;016A 8745 0040
MOVEU.W A1,R2 ;016C 8A10
MOVE.W #$00,R3 ;016D EB80
MOVE.W #$01,Y1 ;016E E781
MOVE.W #>$ABCD,X:$107 ;016F 8654 0107 ABCD
JSR $865D ;0172 E254 865D
MOVEU.W #$7E00,R0 ;0174 8748 7E00
MOVE.W R0,A ;0176 8008
MOVEU.W #$09,R3 ;0177 874B 0009
MOVE.W #>$FF,Y1 ;0179 8747 00FF
MOVE.W #$20,Y0 ;017B E5A0
MOVEU.W A1,R2 ;017C 8A10
JSR $865D ;017D E254 865D
MOVEU.W #$7E00,R0 ;017F 8748 7E00
MOVE.W R0,Y0 ;0181 8508
MOVEU.W #$7EFF,R0 ;0182 8748 7EFF
MOVE.W R0,Y1 ;0184 8708
JSR $84AB ;0185 E254 84AB
MOVE.W #>$ABCD,X:SIM_SWC0 ;0187 8654 F102 ABCD
BFCLR #$02,X:>COP_CTRL ;018A 8054 F120 0002
JMP L7F4A ;018D E154 7F4A
;===========================================================================================
L018F: RTS ;018F E708
;===========================================================================================
L000190: TST.B Y0 ;0190 72A3
MOVE.W #$00,A ;0191 E080
BLS L01AD ;0192 AD1A
NOP ;0193 E700
ZXT.B A,B ;0194 7C82
MOVE.W B1,R0 ;0195 E128
ADDA R2,R0 ;0196 8930
L0197: MOVEU.BP X:(R0)+,B ;0197 F9A0
ZXT.B Y1,X0 ;0198 7E72
EOR.W B,X0 ;0199 7A1A
MOVE.W X0,B ;019A 8104
ASLL.W #$01,B ;019B 5CF1
MOVE.W X0,Y1 ;019C 8704
EOR.W X0,B ;019D 78CA
ASLL.W #$02,Y1 ;019E 5FF2
EOR.W B,Y1 ;019F 7B9A
BRCLR #$80,X0,L01A4 ;01A0 8B44 8002
BFCHG #$09,Y1 ;01A2 8547 0009
L01A4: BRCLR #$40,X0,L01A8 ;01A4 8B44 4002
BFCHG #$07,Y1 ;01A6 8547 0007
L01A8: INC.W A ;01A8 7003
CMP.B A,Y0 ;01A9 7A85
ZXT.B Y1,Y1 ;01AA 7FF2
BHI L0197 ;01AB AC6B
NOP ;01AC E700
L01AD: MOVE.BP Y1,X:(R3) ;01AD D7B7
RTS ;01AE E708
;===========================================================================================
L0001AF: ADDA #$02,SP ;01AF 827B
MOVE.L C10,X:(SP) ;01B0 D23F
MOVE.W Y1,C ;01B1 8207
MOVE.W #>$FF,Y1 ;01B2 8747 00FF
JSR $84CB ;01B4 E254 84CB
NOT.W Y0 ;01B6 72C3
ADD.W #$01,Y0 ;01B7 4681
MOVE.W Y0,A ;01B8 8005
LSRR.W #$08,A ;01B9 5C28
ASLL.W #$08,Y0 ;01BA 5EF8
OR.W A,Y0 ;01BB 7A89
MOVE.W Y0,X:>$09 ;01BC D57C 0009
MOVEU.W #$09,R3 ;01BE 874B 0009
MOVE.W #$20,Y0 ;01C0 E5A0
MOVEU.W C1,R2 ;01C1 8A12
MOVE.W #$01,Y1 ;01C2 E781
JSR $865D ;01C3 E254 865D
MOVE.L X:(SP)-,C ;01C5 F23B
RTS ;01C6 E708
;===========================================================================================
L0001C7: MOVEU.W #$500,R0 ;01C7 8748 0500
MOVE.W #>$71FF,Y1 ;01C9 8747 71FF
MOVE.W R0,Y0 ;01CB 8508
JSR $84CB ;01CC E254 84CB
RTS ;01CE E708
;===========================================================================================
L0001CF: ADDA #$02,SP ;01CF 827B
ADDA #-$01,SP,R1 ;01D0 8AB5 FFFF
ADD Y0,Y1 ;01D2 7BD0
MOVE.W #$00,X:(R1) ;01D3 8641 0000
BRA L01E5 ;01D5 A90F
;===========================================================================================
L01D6: MOVEU.W Y0,R0 ;01D6 8805
MOVE.W P:(R0)+,A1 ;01D7 8368
MOVE.W A1,X:(SP) ;01D8 D01F
MOVE.W #>$FF,B ;01D9 8741 00FF
AND.W A,B ;01DB 7888
LSRR.W #$08,A ;01DC 5C28
INC.W Y0 ;01DD 7283
MOVE.W A1,X:(SP) ;01DE D01F
MOVE.W X:(SP),X0 ;01DF F41F
ADD B,X0 ;01E0 7A10
MOVE.W X0,X:(SP) ;01E1 D41F
MOVE.W X:(R1),A ;01E2 F015
ADD.W X:(SP),A ;01E3 445F
MOVE.W A1,X:(R1) ;01E4 D015
L01E5: CMP.W Y0,Y1 ;01E5 7BD6
BHI L01D6 ;01E6 AC6F
NOP ;01E7 E700
MOVE.W X:(R1),Y0 ;01E8 F515
SUBA #$02,SP ;01E9 9F7E
RTS ;01EA E708
;===========================================================================================
L0001EB: ADDA #$02,SP ;01EB 827B
MOVE.L C10,X:(SP) ;01EC D23F
ADDA #$02,SP ;01ED 827B
MOVEU.W #$76FF,R0 ;01EE 8748 76FF
MOVE.W #$00,C ;01F0 E280
MOVE.W P:(R0)+,A1 ;01F1 8368
MOVE.W A1,X:(SP) ;01F2 D01F
JSR $84C3 ;01F3 E254 84C3
ADD.W X:(SP),Y0 ;01F5 46DF
TST.W Y0 ;01F6 8F05
BEQ L01FA ;01F7 A302
NOP ;01F8 E700
MOVE.W #$01,C ;01F9 E281
L01FA: MOVE.W C1,Y0 ;01FA 8512
SUBA #$02,SP ;01FB 9F7E
MOVE.L X:(SP)-,C ;01FC F23B
RTS ;01FD E708
;===========================================================================================
L0001FE: ADDA #$04,SP ;01FE 847B
JSR $85E0 ;01FF E254 85E0
MOVE.W X:>I2C_RISTAT,A ;0201 F07C F29A
BRCLR #$04,A1,L0222 ;0203 8B50 041D
MOVEU.BP X:$219,A ;0205 F8FD 0219
CMP.B #$20,A ;0207 5C42 0020
BCC L0220 ;0209 A016
MOVEU.BP X:$218,B ;020A F9FD 0218
MOVE.W B1,A ;020C 8011
ADD.W #$01,A ;020D 4401
INC.BP X:$219 ;020E 4EC6 0219
MOVE.BP A1,X:$218 ;0210 D0FD 0218
MOVEU.W B1,N ;0212 8E11
MOVEU.W #$23A,R0 ;0213 8748 023A
MOVE.W X:>I2C_DATA,A ;0215 F07C F288
MOVE.BP A1,X:(R0+N) ;0217 D0A4
MOVEU.BP X:$218,A ;0218 F8FD 0218
CMP.B #$20,A ;021A 5C42 0020
BCS L0222 ;021C A105
CLR.BP X:$218 ;021D D9FD 0218
BRA L0222 ;021F A902
;===========================================================================================
L0220: MOVE.W X:>I2C_DATA,A ;0220 F07C F288
L0222: MOVE.W X:>I2C_CLRRDREQ,A ;0222 F07C F2A8
BFTSTL #$01,A1 ;0224 8950 0001
BCS >L028B ;0226 E168 0064
TST.BP X:$219 ;0228 D8FD 0219
BEQ >L026C ;022A E368 0041
JSR $85C1 ;022C E254 85C1
MOVEU.BP X:$219,A ;022E F8FD 0219
CMP.B #$01,A ;0230 5421
BNE L026A ;0231 A238
JSR $8337 ;0232 E254 8337
TST.BP X:$217 ;0234 D8FD 0217
BEQ L026A ;0236 A333
NOP ;0237 E700
ASLA SP,R0 ;0238 80B4
MOVEU.BP X:$214,B ;0239 F9FD 0214
ADDA #-$06,R0,R0 ;023B 8A20 FFFA
MOVE.BP B1,X:(R0) ;023D D1B4
ASLA SP,R0 ;023E 80B4
ADDA #-$06,R0,R0 ;023F 8A20 FFFA
MOVEU.BP X:$23A,A ;0241 F8FD 023A
MOVE.BP A1,X:(R0+$01) ;0243 D0E4 0001
ASLA SP,R0 ;0245 80B4
ASLA SP,R2 ;0246 80B6
ASLA SP,R3 ;0247 80B7
ADDA #-$06,R0,R0 ;0248 8A20 FFFA
ADD.W #$01,B ;024A 4481
ADDA #-$06,R2,R2 ;024B 8A32 FFFA
ADDA #$00,R3,R3 ;024D 8237 0000
MOVE.W #$03,Y0 ;024F E583
MOVE.W #$00,Y1 ;0250 E780
MOVE.BP B1,X:(R0+$02) ;0251 D1E4 0002
JSR $848C ;0253 E254 848C
ASLA SP,R3 ;0255 80B7
MOVEU.BP X:$217,Y0 ;0256 FDFD 0217
MOVEU.W #$21A,R2 ;0258 874A 021A
ADDA #-$01,R3,R3 ;025A 8A37 FFFF
MOVEU.B X:(SP),Y1 ;025C FFBF
JSR $848C ;025D E254 848C
MOVEU.BP X:$217,B ;025F F9FD 0217
MOVE.W B1,A ;0261 8011
ADD.W #$01,A ;0262 4401
MOVE.BP A1,X:$217 ;0263 D0FD 0217
MOVEU.B X:(SP-$01),A ;0265 B83F
MOVEU.W B1,N ;0266 8E11
MOVEU.W #$21A,R0 ;0267 8748 021A
MOVE.BP A1,X:(R0+N) ;0269 D0A4
L026A: JSR $85C6 ;026A E254 85C6
L026C: TST.BP X:$217 ;026C D8FD 0217
BEQ L0288 ;026E A319
MOVEU.BP X:$216,B ;026F F9FD 0216
MOVE.W B1,A ;0271 8011
ADD.W #$01,A ;0272 4401
MOVE.BP A1,X:$216 ;0273 D0FD 0216
DEC.BP X:$217 ;0275 4E46 0217
MOVEU.W B1,N ;0277 8E11
MOVEU.W #$21A,R0 ;0278 8748 021A
MOVEU.BP X:(R0+N),B ;027A F9A4
MOVE.W #>$FF,A ;027B 8740 00FF
AND.W B,A ;027D 7818
MOVE.W A1,X:>I2C_DATA ;027E D07C F288
MOVEU.BP X:$216,A ;0280 F8FD 0216
CMP.B #$20,A ;0282 5C42 0020
BCS L028B ;0284 A106
CLR.BP X:$216 ;0285 D9FD 0216
BRA L028B ;0287 A903
;===========================================================================================
L0288: MOVE.W #>$FF,X:I2C_DATA ;0288 8654 F288 00FF
L028B: MOVE.W X:>I2C_CLRSTPDET,A ;028B F07C F2B0
BRCLR #$01,A1,L0299 ;028D 8B50 010A
MOVEU.BP X:$219,A ;028F F8FD 0219
CMP.B #$01,A ;0291 5421
BLS L0299 ;0292 AD06
JSR $83A4 ;0293 E254 83A4
JSR $85C1 ;0295 E254 85C1
JSR $85C6 ;0297 E254 85C6
L0299: SUBA #$04,SP ;0299 9F7C
RTS ;029A E708
;===========================================================================================
L00029B: BFCLR #$01,X:>I2C_ENBL ;029B 8054 F2B6 0001
BFSET #$40,X:>SIM_PCE0 ;029E 8254 F10C 0040
BFSET #$82,X:>GPIOB_PEREN ;02A1 8254 F163 0082
BFSET #$04,X:>SIM_GPSB0 ;02A4 8254 F115 0004
BFSET #$01,X:>SIM_GPSB1 ;02A7 8254 F116 0001
MOVE.W #>$98,X:I2C_SSHCNT ;02AA 8654 F28A 0098
MOVE.W #>$9F,X:I2C_SSLCNT ;02AD 8654 F28C 009F
MOVEU.BP X:$214,A ;02B0 F8FD 0214
ASRR.W #$01,A ;02B2 5C61
MOVE.W A1,X:>I2C_SAR ;02B3 D07C F284
MOVE.W #$02,X:I2C_CTRL ;02B5 E682 F280
MOVE.W #$00,X:I2C_RXFT ;02B7 E680 F29C
MOVE.W #$00,X:I2C_TXFT ;02B9 E680 F29E
MOVE.W #$00,X:I2C_IMASK ;02BB E680 F298
BFSET #$01,X:>I2C_ENBL ;02BD 8254 F2B6 0001
JSR $85C6 ;02C0 E254 85C6
JSR $85C1 ;02C2 E254 85C1
RTS ;02C4 E708
;===========================================================================================
L0002C5: CLR.BP X:$217 ;02C5 D9FD 0217
CLR.BP X:$216 ;02C7 D9FD 0216
RTS ;02C9 E708
;===========================================================================================
L0002CA: CLR.BP X:$219 ;02CA D9FD 0219
CLR.BP X:$218 ;02CC D9FD 0218
RTS ;02CE E708
;===========================================================================================
L0002CF: MOVEU.W #$23C,R2 ;02CF 874A 023C
MOVEU.W #$09,R1 ;02D1 8749 0009
MOVE.W #$00,B ;02D3 E180
TFRA R2,R0 ;02D4 8130
ADDA #$01,R0 ;02D5 8170
L02D6: MOVEU.BP X:(R2),A ;02D6 F8B6
MOVEU.BP X:(R0),Y0 ;02D7 FDB4
ASLL.W #$08,A ;02D8 5C78
ADD A,Y0 ;02D9 7A80
INC.W B ;02DA 7083
MOVE.W Y0,X:(R1)+ ;02DB D501
CMP.B #$08,B ;02DC 54A8
ADDA #$02,R0 ;02DD 8270
ADDA #$02,R2 ;02DE 8272
BCS L02D6 ;02DF A176
BFSET #$400,X:>$10A ;02E0 8254 010A 0400
RTS ;02E3 E708
;===========================================================================================
L0002E4: MOVE.W X:>GPIOB_DATA,A ;02E4 F07C F161
BFTSTL #$200,A1 ;02E6 8950 0200
MOVE.W #>$BE,B ;02E8 8741 00BE
BCS L02ED ;02EA A102
BFSET #$02,B1 ;02EB 8351 0002
L02ED: MOVE.W X:>GPIOD_DATA,A ;02ED F07C F181
BRCLR #$20,A1,L02F3 ;02EF 8B50 2002
BFSET #$04,B1 ;02F1 8351 0004
L02F3: MOVE.W X:>GPIOA_DATA,A ;02F3 F07C F151
BRCLR #$4000,A1,L02F9 ;02F5 8B50 4082
BFSET #$08,B1 ;02F7 8351 0008
L02F9: CMP.BP X:$214,B ;02F9 5CC6 0214
BEQ L0300 ;02FB A304
MOVE.BP B1,X:$214 ;02FC D1FD 0214
JSR $8597 ;02FE E254 8597
L0300: RTS ;0300 E708
;===========================================================================================
L000301: BRA L0311 ;0301 A90F
;===========================================================================================
L0302: TFRA R2,R0 ;0302 8130
ADDA #$01,R2 ;0303 8172
MOVE.W P:(R0)+,B1 ;0304 8668
TST.B Y1 ;0305 73A3
BEQ L030C ;0306 A305
NOP ;0307 E700
MOVE.BP B1,X:(R3)+ ;0308 D1A3
LSRR.W #$08,B ;0309 5CA8
MOVE.BP B1,X:(R3)+ ;030A D1A3
BRA L0310 ;030B A904
;===========================================================================================
L030C: MOVE.W B1,A ;030C 8011
LSRR.W #$08,A ;030D 5C28
MOVE.BP A1,X:(R3)+ ;030E D0A3
MOVE.BP B1,X:(R3)+ ;030F D1A3
L0310: DEC.W Y0 ;0310 728B
L0311: TST.W Y0 ;0311 8F05
BGT L0302 ;0312 A66F
NOP ;0313 E700
NOP ;0314 E700
RTS ;0315 E708
;===========================================================================================
L000316: ADDA #$02,SP ;0316 827B
MOVE.L C10,X:(SP) ;0317 D23F
MOVEU.W #$500,R0 ;0318 8748 0500
MOVE.W R0,C ;031A 8208
BRA L0325 ;031B A909
;===========================================================================================
L031C: MOVE.W #>$40,Y0 ;031C 8745 0040
MOVEU.W C1,R2 ;031E 8A12
MOVE.W #$00,R3 ;031F EB80
MOVE.W #$01,Y1 ;0320 E781
JSR $865D ;0321 E254 865D
ADD.W #>$100,C ;0323 4540 0100
L0325: MOVEU.W #$76FF,R0 ;0325 8748 76FF
MOVE.W R0,A ;0327 8008
CMP.W C,A ;0328 7826
BCC L031C ;0329 A072
BFSET #$200,X:>$10A ;032A 8254 010A 0200
BFSET #$04,X:>$02 ;032D 8254 0002 0004
MOVE.L X:(SP)-,C ;0330 F23B
RTS ;0331 E708
;===========================================================================================
L000332: ADDA #$02,SP ;0332 827B
MOVE.L C10,X:(SP) ;0333 D23F
MOVEU.W #$500,R0 ;0334 8748 0500
MOVE.W X:>$109,B ;0336 F17C 0109
MOVE.W R0,A ;0338 8008
CMP.W B,A ;0339 7816
BHI L0359 ;033A AC1E
MOVEU.W #$76FF,R0 ;033B 8748 76FF
MOVE.W R0,C ;033D 8208
CMP.W B,C ;033E 7916
BCS L0359 ;033F A119
MOVEU.W #$09,R3 ;0340 874B 0009
MOVE.W #$20,Y0 ;0342 E5A0
MOVEU.W B1,R2 ;0343 8A11
MOVE.W #$08,Y1 ;0344 E788
JSR $865D ;0345 E254 865D
MOVE.W #$08,A ;0347 E088
ADD.W A,X:$109 ;0348 7457 0109
CMP.W X:$109,C ;034A 4D44 0109
BHI L035C ;034C AC0F
JSR $84E7 ;034D E254 84E7
TST.B Y0 ;034F 72A3
BNE L0355 ;0350 A204
BFCLR #$04,X:>$02 ;0351 8054 0002 0004
BRA L035C ;0354 A907
;===========================================================================================
L0355: BFSET #$04,X:>$02 ;0355 8254 0002 0004
BRA L035C ;0358 A903
;===========================================================================================
L0359: BFSET #$08,X:>$02 ;0359 8254 0002 0008
L035C: BFCLR #$400,X:>$10A ;035C 8054 010A 0400
MOVE.L X:(SP)-,C ;035F F23B
RTS ;0360 E708
;===========================================================================================
L000361: MOVE.W #$00,A ;0361 E080
BFCLR #$FFFF,X:>FM_PROT ;0362 8054 F410 FFFF
BRA L038A ;0365 A924
;===========================================================================================
L0366: MOVE.W X:>FM_USTAT,B ;0366 F17C F413
BRCLR #$80,B1,L0366 ;0368 8B51 807C
NOP ;036A E700
MOVE.W X:(R3),B ;036B F117
TFRA R2,R0 ;036C 8130
MOVE.W B1,P:(R0)+N ;036D 8664
MOVE.W Y0,X:>FM_CMD ;036E D57C F414
BFSET #$80,X:>FM_USTAT ;0370 8254 F413 0080
MOVE.W X:>FM_USTAT,B ;0373 F17C F413
BRCLR #$30,B1,L0379 ;0375 8B51 3002
NOP ;0377 E700
MOVE.W #$01,A ;0378 E081
L0379: MOVE.W X:>FM_USTAT,B ;0379 F17C F413
BRCLR #$40,B1,L0379 ;037B 8B51 407C
CMP.W #$20,Y0 ;037D 5EC0 0020
BNE L0387 ;037F A207
NOP ;0380 E700
TFRA R2,R0 ;0381 8130
MOVE.W P:(R0)+,B1 ;0382 8668
CMP.W X:(R3),B ;0383 4CD7
BEQ L0387 ;0384 A302
NOP ;0385 E700
MOVE.W #$01,A ;0386 E081
L0387: DEC.W Y1 ;0387 738B
ADDA #$01,R2 ;0388 8172
ADDA #$01,R3 ;0389 8173
L038A: TST.W Y1 ;038A 8F07
BEQ L038F ;038B A303
NOP ;038C E700
TST.B A ;038D 7023
BEQ L0366 ;038E A357
L038F: BFSET #$FFFF,X:>FM_PROT ;038F 8254 F410 FFFF
MOVE.W A1,Y0 ;0392 8510
RTS ;0393 E708
;===========================================================================================
L000394: BFCLR #$8000,X:>SIM_PCR ;0394 8054 F10B 8000
BFSET #$20,X:>SIM_PCE1 ;0397 8254 F10D 0020
MOVE.W #>$F424,X:TMRB1_COMP1 ;039A 8654 F050 F424
MOVE.W #$00,X:TMRB1_COMP2 ;039D E680 F051
MOVE.W #$00,X:TMRB1_CAPT ;039F E680 F052
MOVE.W #$00,X:TMRB1_LOAD ;03A1 E680 F053
MOVE.W #$00,X:TMRB1_CNTR ;03A3 E680 F055
MOVE.W #$00,X:TMRB1_SCTRL ;03A5 E680 F057
MOVE.W #>$F424,X:TMRB1_CMPLD1 ;03A7 8654 F058 F424
MOVE.W #$00,X:TMRB1_CMPLD2 ;03AA E680 F059
MOVE.W #>$40,X:TMRB1_CSCTRL ;03AC 8654 F05A 0040
MOVE.W #$00,X:TMRB1_FILT ;03AF E680 F05B
MOVE.W #>$3E23,X:TMRB1_CTRL ;03B1 8654 F056 3E23
BFSET #$02,X:>TMRB0_ENBL ;03B4 8254 F04F 0002
RTS ;03B7 E708
;===========================================================================================
L0003B8: MOVEU.W #$04,R0 ;03B8 8748 0004
MOVE.W X:(R0),B ;03BA F114
MOVE.W X:>TMRB1_CNTR,A ;03BB F07C F055
MOVE.W A1,X:(R0) ;03BD D014
CMP.W X:(R0),B ;03BE 4CD4
BLS L03C2 ;03BF AD02
INC.BP X:$0A ;03C0 4EC6 000A
L03C2: MOVEU.BP X:$0A,A ;03C2 F8FD 000A
CMP.B #$02,A ;03C4 5422
BCS L03CC ;03C5 A106
CLR.BP X:$0A ;03C6 D9FD 000A
JSR $86C9 ;03C8 E254 86C9
JSR $86FD ;03CA E254 86FD
L03CC: RTS ;03CC E708
;===========================================================================================
L0003CD: MOVEU.BP X:$0B,A ;03CD F8FD 000B
CMP.B #$02,A ;03CF 5422
BNE L03D4 ;03D0 A203
MOVE.W #$33,X:$06 ;03D1 E6B3 0006
BRA L0400 ;03D3 A92C
;===========================================================================================
L03D4: CMP.B #$03,A ;03D4 5423
BNE L03D9 ;03D5 A203
MOVE.W #$0C,X:$06 ;03D6 E68C 0006
BRA L0400 ;03D8 A927
;===========================================================================================
L03D9: CMP.B #$04,A ;03D9 5424
BNE L03DE ;03DA A203
MOVE.W #$11,X:$06 ;03DB E691 0006
BRA L0400 ;03DD A922
;===========================================================================================
L03DE: CMP.B #$05,A ;03DE 5425
BNE L03E3 ;03DF A203
MOVE.W #$04,X:$06 ;03E0 E684 0006
BRA L0400 ;03E2 A91D
;===========================================================================================
L03E3: BRSET #$08,X:>$02,L03FB ;03E3 8E54 0002 0815