forked from acco/chti23
Update 'soft/PjtKEIL_StepSon/Src/GestionSon.s'
This commit is contained in:
parent
5fad572de4
commit
e6d340948e
1 changed files with 44 additions and 49 deletions
|
@ -1,6 +1,11 @@
|
||||||
PRESERVE8
|
PRESERVE8
|
||||||
THUMB
|
THUMB
|
||||||
|
|
||||||
|
import LongueurSon
|
||||||
|
import PeriodeSonMicroSec
|
||||||
|
import Son
|
||||||
|
|
||||||
|
include Driver/DriverJeuLaser.inc
|
||||||
|
|
||||||
; ====================== zone de réservation de données, ======================================
|
; ====================== zone de réservation de données, ======================================
|
||||||
;Section RAM (read only) :
|
;Section RAM (read only) :
|
||||||
|
@ -10,59 +15,49 @@
|
||||||
;Section RAM (read write):
|
;Section RAM (read write):
|
||||||
area maram,data,readwrite
|
area maram,data,readwrite
|
||||||
|
|
||||||
SortieSon equ 0
|
|
||||||
Index equ 0
|
Son_index dcd 0
|
||||||
|
SortieSon dcw 0
|
||||||
import LongueurSon
|
|
||||||
import Son
|
|
||||||
import PWM_Set_Value_TIM3_Ch3
|
|
||||||
export CallBackSon
|
|
||||||
; ===============================================================================================
|
; ===============================================================================================
|
||||||
|
|
||||||
|
|
||||||
|
EXPORT Son_index
|
||||||
|
EXPORT SortieSon
|
||||||
|
|
||||||
|
|
||||||
;Section ROM code (read only) :
|
;Section ROM code (read only) :
|
||||||
area moncode,code,readonly
|
area moncode,code,readonly
|
||||||
; écrire le code ici
|
; écrire le code ici
|
||||||
|
EXPORT StartSon
|
||||||
|
EXPORT CallbackSon
|
||||||
CallBackSon proc
|
|
||||||
ldr r0, =Index ; Chargement de l'adresse mémoire de la variable "Index" dans le registre r0
|
|
||||||
ldr r1, [r0] ; Chargement de la valeur de la variable "Index" depuis la mémoire dans le registre r1
|
|
||||||
|
|
||||||
ldr r2, =LongueurSon ; Chargement de l'adresse mémoire de la variable "LongueurSon" dans le registre r2
|
|
||||||
ldr r2, [r2] ; Chargement de la valeur de la variable "LongueurSon" depuis la mémoire dans le registre r2
|
|
||||||
|
|
||||||
cmp r1, r2 ; Comparaison de la valeur de la variable "Index" (r1) avec la valeur de la variable "LongueurSon" (r2)
|
StartSon proc
|
||||||
beq FIN_Son ; Branchement à l'étiquette "FIN_Son" si les valeurs comparées sont égales
|
mov r0, #0 ; Charger la valeur 0 dans le registre r0
|
||||||
|
ldr r1, =Son_index ; Charger l'adresse de la variable Son_index dans le registre r1
|
||||||
add r1, #1 ; Ajout de 1 à la valeur du registre r1
|
str r0, [r1] ; Stocker la valeur de r0 dans la variable Son_index
|
||||||
str r1, [r0] ; Stockage de la valeur de r1 dans la mémoire à l'adresse de la variable "Index"
|
bx lr ; Retourner à l'appelant
|
||||||
sub r1, #1 ; Soustraction de 1 à la valeur du registre r1
|
endp; Fin de la procédure StartSon
|
||||||
ldr r3, =Son ; Chargement de l'adresse mémoire de la variable "Son" dans le registre r3
|
|
||||||
ldrsh r3, [r3,r1,LSL #1] ; Chargement du contenu de la variable "Son" depuis la mémoire à l'adresse "r3+r1*2" dans le registre r3
|
|
||||||
|
|
||||||
add r3, #0x8000 ; Ajout de la valeur hexadécimale 0x8000 (32768 en décimal) à la valeur de r3
|
|
||||||
mov r0, #0x2CF ; Stockage de la valeur hexadécimale 0x2CF (719 en décimal) dans le registre r0
|
|
||||||
mul r3,r0 ; Multiplication de la valeur de r3 par la valeur de r0
|
|
||||||
mov r0,#0xFFFF ; Stockage de la valeur hexadécimale 0xFFFF (65535 en décimal) dans le registre r0
|
|
||||||
udiv r3,r0 ; Division de la valeur de r3 par la valeur de r0 sans signe
|
|
||||||
|
|
||||||
|
|
||||||
ldr r0, =SortieSon ; Chargement de l'adresse mémoire de la variable "SortieSon" dans le registre r0
|
|
||||||
str r3, [r0] ; Stockage de la valeur de r3 dans la mémoire à l'adresse de la variable "SortieSon"
|
|
||||||
mov r0, r3 ; Copie de la valeur de r3 dans le registre r0
|
|
||||||
|
|
||||||
bl PWM_Set_Value_TIM3_Ch3 ; Appel d'une fonction nommée "PWM_Set_Value_TIM3_Ch3" avec la valeur de r0 comme argument
|
|
||||||
|
|
||||||
FIN_Son
|
CallbackSon proc
|
||||||
mov r0, #0 ; Stockage de la valeur zéro dans le registre r0
|
ldr r1, =LongueurSon
|
||||||
ldr r2, =SortieSon ; Chargement de l'adresse mémoire de la variable "SortieSon" dans le registre r2
|
ldr r0, [r1]
|
||||||
str r0, [r2] ; Stockage de la valeur de r0 dans la mémoire à l'adresse de la variable "SortieSon"
|
ldr r1, =Son_index
|
||||||
bx lr ; Retour de la fonction avec l'utilisation de la valeur contenue dans le registre de lien (lr)
|
ldr r2, [r1]
|
||||||
|
cmp r0, r2
|
||||||
endp
|
bls fin ; if (LongeurSon <= Son_index) ;
|
||||||
|
ldr r3, =Son
|
||||||
END
|
ldrsh r0, [r3, r1, lsl #1] ; r0 = Son[Son_index]
|
||||||
|
add r0, #32768
|
||||||
|
mov r3, #720
|
||||||
|
mul r0, r3
|
||||||
|
lsr r0, #16 ;x in [-32768; 32767] -> x in [0; 719] // divise r0 par 65536
|
||||||
|
ldr r3, =SortieSon
|
||||||
|
str r0, [r3] ; Sortie_son = x
|
||||||
|
add r2, r2, #1
|
||||||
|
str r2, [r1] ; Son_index++;
|
||||||
|
b PWM_Set_Value_TIM3_Ch3
|
||||||
|
fin
|
||||||
|
bx lr
|
||||||
|
endp
|
||||||
|
END
|
Loading…
Reference in a new issue