introduction du StarSon et modification du CallbackSon

This commit is contained in:
Oussama El-Jid 2023-04-11 18:00:06 +02:00
parent e243030bba
commit a6a090d347

View file

@ -1,20 +1,11 @@
PRESERVE8 PRESERVE8
THUMB THUMB
EXPORT CallbackSon
EXPORT SortieSon
EXPORT i
IMPORT Son
IMPORT LongueurSon
INCLUDE DriverJeuLaser.inc
;void CallbackSon(void){
; static int i = 0;
; if(i < 5512){
;0 SortieSon = (Son[i] + 32768) * 719 / 65535;
; i++;
; }
;}
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) :
@ -24,48 +15,49 @@
;Section RAM (read write): ;Section RAM (read write):
area maram,data,readwrite area maram,data,readwrite
i dcd 0
SortieSon dcw 0
Son_index dcd 0
SortieSon dcw 0
; =============================================================================================== ; ===============================================================================================
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
CallbackSon proc EXPORT CallbackSon
push {lr}
StartSon proc
ldr r0,=i mov r0, #0 ; Charger la valeur 0 dans le registre r0
ldr r1, [r0] ldr r1, =Son_index ; Charger l'adresse de la variable Son_index dans le registre r1
ldr r2,LongueurSon str r0, [r1] ; Stocker la valeur de r0 dans la variable Son_index
cmp r2, r1 bx lr ; Retourner à l'appelant
; if(i < 5512) endp; Fin de la procédure StartSon
ble fin
ldr r3,=Son
ldrsh r2, [r3,r1, LSL#1]
add r2, #32768
mov r12, #719
mul r2, r12
mov r12, #65535
udiv r2, r12
; i++;
add r1, #1
str r1, [r0]
; On stocke enfin la sortie son
ldr r0, =SortieSon
strh r2, [r0]
mov r0, r2
bl PWM_Set_Value_TIM3_Ch3
CallbackSon proc
ldr r1, =LongueurSon
ldr r0, [r1]
ldr r1, =Son_index
ldr r2, [r1]
cmp r0, r2
bls fin ; if (LongeurSon <= Son_index) ;
ldr r3, =Son
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 fin
pop {pc} bx lr
ENDFUNC endp
END
END