avr.inc 5.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269
  1. {
  2. This file is part of the Free Pascal run time library.
  3. Copyright (c) 2008 by the Free Pascal development team.
  4. Processor dependent implementation for the system unit for
  5. AVR
  6. See the file COPYING.FPC, included in this distribution,
  7. for details about the copyright.
  8. This program is distributed in the hope that it will be useful,
  9. but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  11. **********************************************************************}
  12. {$asmmode gas}
  13. const
  14. {$i cpuinnr.inc}
  15. { Reads SREG and then disables interrupts, returns contents of SREG }
  16. function avr_save: byte;[INTERNPROC: in_avr_save];
  17. { Restores SREG }
  18. procedure avr_restore(old_sreg: byte); [INTERNPROC: in_avr_restore];
  19. procedure fpc_cpuinit;{$ifdef SYSTEMINLINE}inline;{$endif}
  20. begin
  21. end;
  22. {$define FPC_SYSTEM_HAS_MOVE}
  23. procedure Move(const source;var dest;count:SizeInt);[public, alias: 'FPC_MOVE']; assembler; nostackframe;
  24. asm
  25. push r28
  26. push r29
  27. movw r26, r24 // Src=X
  28. movw r28, r22 // Dest=Y
  29. movw r30, r20 // Count=Z
  30. cp r1, r30
  31. cpc r1, r31
  32. brge .Lexit // if 0 >= Count
  33. cp r28, r26
  34. cpc r29, r27
  35. breq .Lexit // if dest = source
  36. brlo .LForwardMove // if dest < source
  37. // Add count to both pointers
  38. add r26, r30
  39. adc r27, r31
  40. add r28, r30
  41. adc r29, r31
  42. .LBackwardMove:
  43. ld r18, -X
  44. st -Y, r18
  45. sbiw Z, 1
  46. brne .LBackwardMove
  47. rjmp .Lexit
  48. .LForwardMove:
  49. ld r18, X+
  50. st Y+, r18
  51. sbiw Z, 1
  52. brne .LForwardMove
  53. .Lexit:
  54. pop r29
  55. pop r28
  56. end;
  57. {$define FPC_SYSTEM_HAS_FILLCHAR}
  58. Procedure FillChar(var x;count:SizeInt;value:byte);
  59. var
  60. pdest,pend : pbyte;
  61. v : ptruint;
  62. begin
  63. if count <= 0 then
  64. exit;
  65. pdest:=@x;
  66. pend:=pdest+count;
  67. while pdest<pend do
  68. begin
  69. pdest^:=value;
  70. inc(pdest);
  71. end;
  72. end;
  73. {$IFNDEF INTERNAL_BACKTRACE}
  74. {$define FPC_SYSTEM_HAS_GET_FRAME}
  75. function get_frame:pointer;assembler;nostackframe;
  76. asm
  77. end;
  78. {$ENDIF not INTERNAL_BACKTRACE}
  79. {$define FPC_SYSTEM_HAS_GET_CALLER_ADDR}
  80. function get_caller_addr(framebp:pointer;addr:pointer=nil):pointer;assembler;nostackframe;
  81. asm
  82. end;
  83. {$define FPC_SYSTEM_HAS_GET_CALLER_FRAME}
  84. function get_caller_frame(framebp:pointer;addr:pointer=nil):pointer;assembler;nostackframe;
  85. asm
  86. end;
  87. {$define FPC_SYSTEM_HAS_SPTR}
  88. Function Sptr : pointer;assembler;nostackframe;
  89. asm
  90. end;
  91. function InterLockedDecrement (var Target: longint) : longint;
  92. var
  93. temp_sreg : byte;
  94. begin
  95. { block interrupts }
  96. temp_sreg:=avr_save();
  97. Result:=Target-1;
  98. Target:=Result;
  99. { release interrupts }
  100. avr_restore(temp_sreg);
  101. end;
  102. function InterLockedIncrement (var Target: longint) : longint;
  103. var
  104. temp_sreg : byte;
  105. begin
  106. { block interrupts }
  107. temp_sreg:=avr_save();
  108. Result:=Target+1;
  109. Target:=Result;
  110. { release interrupts }
  111. avr_restore(temp_sreg);
  112. end;
  113. function InterLockedExchange (var Target: longint;Source : longint) : longint;
  114. var
  115. temp_sreg : byte;
  116. begin
  117. { block interrupts }
  118. temp_sreg:=avr_save();
  119. Result:=Target;
  120. Target:=Source;
  121. { release interrupts }
  122. avr_restore(temp_sreg);
  123. end;
  124. function InterlockedCompareExchange(var Target: longint; NewValue: longint; Comperand: longint): longint;
  125. var
  126. temp_sreg : byte;
  127. begin
  128. { block interrupts }
  129. temp_sreg:=avr_save();
  130. Result:=Target;
  131. if Result=Comperand then
  132. Target:=NewValue;
  133. { release interrupts }
  134. avr_restore(temp_sreg);
  135. end;
  136. function InterLockedExchangeAdd (var Target: longint;Source : longint) : longint;
  137. var
  138. temp_sreg : byte;
  139. begin
  140. { block interrupts }
  141. temp_sreg:=avr_save();
  142. Result:=Target;
  143. Target:=Result+Source;
  144. { release interrupts }
  145. avr_restore(temp_sreg);
  146. end;
  147. function InterLockedDecrement (var Target: smallint) : smallint;
  148. var
  149. temp_sreg : byte;
  150. begin
  151. { block interrupts }
  152. temp_sreg:=avr_save();
  153. Result:=Target-1;
  154. Target:=Result;
  155. { release interrupts }
  156. avr_restore(temp_sreg);
  157. end;
  158. function InterLockedIncrement (var Target: smallint) : smallint;
  159. var
  160. temp_sreg : byte;
  161. begin
  162. { block interrupts }
  163. temp_sreg:=avr_save();
  164. Result:=Target+1;
  165. Target:=Result;
  166. { release interrupts }
  167. avr_restore(temp_sreg);
  168. end;
  169. function InterLockedExchange (var Target: smallint;Source : smallint) : smallint;
  170. var
  171. temp_sreg : byte;
  172. begin
  173. { block interrupts }
  174. temp_sreg:=avr_save();
  175. Result:=Target;
  176. Target:=Source;
  177. { release interrupts }
  178. avr_restore(temp_sreg);
  179. end;
  180. function InterlockedCompareExchange(var Target: smallint; NewValue: smallint; Comperand: smallint): smallint;
  181. var
  182. temp_sreg : byte;
  183. begin
  184. { block interrupts }
  185. temp_sreg:=avr_save();
  186. Result:=Target;
  187. if Result=Comperand then
  188. Target:=NewValue;
  189. { release interrupts }
  190. avr_restore(temp_sreg);
  191. end;
  192. function InterLockedExchangeAdd (var Target: smallint;Source : smallint) : smallint;
  193. var
  194. temp_sreg : byte;
  195. begin
  196. { block interrupts }
  197. temp_sreg:=avr_save();
  198. Result:=Target;
  199. Target:=Result+Source;
  200. { release interrupts }
  201. avr_restore(temp_sreg);
  202. end;