123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274 |
- {
- This file is part of the Free Pascal run time library.
- Copyright (c) 2008 by the Free Pascal development team.
- Processor dependent implementation for the system unit for
- AVR
- See the file COPYING.FPC, included in this distribution,
- for details about the copyright.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
- **********************************************************************}
- {$asmmode gas}
- const
- {$i cpuinnr.inc}
- { Reads SREG and then disables interrupts, returns contents of SREG }
- function avr_save: byte;[INTERNPROC: in_avr_save];
- { Restores SREG }
- procedure avr_restore(old_sreg: byte); [INTERNPROC: in_avr_restore];
- procedure fpc_cpuinit;{$ifdef SYSTEMINLINE}inline;{$endif}
- begin
- end;
- {$if not(defined(CPUAVR_16_REGS)) and defined(CPUAVR_HAS_MOVW)}
- {$define FPC_SYSTEM_HAS_MOVE}
- procedure Move(const source;var dest;count:SizeInt);[public, alias: 'FPC_MOVE']; assembler; nostackframe;
- asm
- push r28
- push r29
- movw r26, r24 // Src=X
- movw r28, r22 // Dest=Y
- movw r30, r20 // Count=Z
- cp r1, r30
- cpc r1, r31
- brge .Lexit // if 0 >= Count
- cp r28, r26
- cpc r29, r27
- breq .Lexit // if dest = source
- brlo .LForwardMove // if dest < source
- // Add count to both pointers
- add r26, r30
- adc r27, r31
- add r28, r30
- adc r29, r31
- .LBackwardMove:
- ld r18, -X
- st -Y, r18
- sbiw r30, 1
- brne .LBackwardMove
- rjmp .Lexit
- .LForwardMove:
- ld r18, X+
- st Y+, r18
- sbiw r30, 1
- brne .LForwardMove
- .Lexit:
- pop r29
- pop r28
- end;
- {$endif not(defined(CPUAVR_16_REGS)) and defined(CPUAVR_HAS_MOVW)}
- {$define FPC_SYSTEM_HAS_FILLCHAR}
- Procedure FillChar(var x;count:SizeInt;value:byte);
- var
- pdest,pend : pbyte;
- v : ptruint;
- begin
- if count <= 0 then
- exit;
- pdest:=@x;
- pend:=pdest+count;
- while pdest<pend do
- begin
- pdest^:=value;
- inc(pdest);
- end;
- end;
- {$IFNDEF INTERNAL_BACKTRACE}
- {$define FPC_SYSTEM_HAS_GET_FRAME}
- function get_frame:pointer;assembler;nostackframe;
- asm
- end;
- {$ENDIF not INTERNAL_BACKTRACE}
- {$define FPC_SYSTEM_HAS_GET_CALLER_ADDR}
- function get_caller_addr(framebp:pointer;addr:pointer=nil):pointer;assembler;nostackframe;
- asm
- end;
- {$define FPC_SYSTEM_HAS_GET_CALLER_FRAME}
- function get_caller_frame(framebp:pointer;addr:pointer=nil):pointer;assembler;nostackframe;
- asm
- end;
- {$define FPC_SYSTEM_HAS_SPTR}
- Function Sptr : pointer;assembler;nostackframe;
- asm
- in r24, 0x3d
- in r25, 0x3e
- end;
- function InterLockedDecrement (var Target: longint) : longint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target-1;
- Target:=Result;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedIncrement (var Target: longint) : longint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target+1;
- Target:=Result;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedExchange (var Target: longint;Source : longint) : longint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target;
- Target:=Source;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterlockedCompareExchange(var Target: longint; NewValue: longint; Comperand: longint): longint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target;
- if Result=Comperand then
- Target:=NewValue;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedExchangeAdd (var Target: longint;Source : longint) : longint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target;
- Target:=Result+Source;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedDecrement (var Target: smallint) : smallint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target-1;
- Target:=Result;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedIncrement (var Target: smallint) : smallint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target+1;
- Target:=Result;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedExchange (var Target: smallint;Source : smallint) : smallint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target;
- Target:=Source;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterlockedCompareExchange(var Target: smallint; NewValue: smallint; Comperand: smallint): smallint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target;
- if Result=Comperand then
- Target:=NewValue;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- function InterLockedExchangeAdd (var Target: smallint;Source : smallint) : smallint;
- var
- temp_sreg : byte;
- begin
- { block interrupts }
- temp_sreg:=avr_save();
- Result:=Target;
- Target:=Result+Source;
- { release interrupts }
- avr_restore(temp_sreg);
- end;
- {include hand-optimized assembler code}
- {$i math.inc}
|