forked from PAWPAW-Mirror/lib_xua
64 lines
1.6 KiB
ArmAsm
64 lines
1.6 KiB
ArmAsm
#include "xs1_kernel.h"
|
|
#include "xs1_user.h"
|
|
|
|
.global write_sswitch_reg_blind, "f{si}(ui,ui,ui)"
|
|
.type write_sswitch_reg_blind, @function
|
|
// r0 - coreid
|
|
// r1 - reg
|
|
// r2 - data
|
|
.cc_top write_sswitch_reg_blind.function, write_sswitch_reg_blind
|
|
.align 2
|
|
write_sswitch_reg_blind:
|
|
// Check range of coreid
|
|
shr r3, r0, XS1_CHAN_ID_PROCESSOR_SIZE + XS1_CHAN_ID_NODE_SIZE
|
|
bt r3, write_switch_reg_fail
|
|
|
|
// Check range of reg
|
|
shr r3, r1, 16
|
|
bt r3, write_switch_reg_fail
|
|
|
|
// Allocate channel end
|
|
getr r3, XS1_RES_TYPE_CHANEND
|
|
|
|
// Set destination
|
|
ldc r11, XS1_RES_TYPE_CONFIG | (XS1_CT_SSCTRL << XS1_CHAN_ID_CHANNUM_SHIFT)
|
|
|
|
// r0 - l
|
|
// r1 - reg
|
|
// r2 - data
|
|
// r3 - chanend
|
|
// r11 - low half of dest
|
|
write_switch_reg:
|
|
shl r0, r0, XS1_CHAN_ID_PROCESSOR_SHIFT
|
|
or r0, r0, r11
|
|
setd res[r3], r0
|
|
|
|
// Send packet
|
|
ldc r11, XS1_CT_WRITEC // Too big for outct immediate
|
|
outct res[r3], r11
|
|
mkmsk r0, 32
|
|
shl r0, r0, 8
|
|
shr r11, r1, 8
|
|
or r0, r0, r11
|
|
out res[r3], r0 // (0xffffff00) | (reg >> 8)
|
|
outt res[r3], r1 // reg & 0xff
|
|
out res[r3], r2
|
|
outct res[r3], XS1_CT_END
|
|
|
|
// Receive response
|
|
freer res[r3]
|
|
retsp 0
|
|
write_switch_reg_fail:
|
|
ldc r0, 0
|
|
retsp 0
|
|
.size write_sswitch_reg_blind, .-write_sswitch_reg_blind
|
|
.cc_bottom write_sswitch_reg_blind.function
|
|
.global write_sswitch_reg_blind.nstackwords
|
|
.global write_sswitch_reg_blind.maxchanends
|
|
.global write_sswitch_reg_blind.maxtimers
|
|
.global write_sswitch_reg_blind.maxcores
|
|
.set write_sswitch_reg_blind.nstackwords, 0
|
|
.set write_sswitch_reg_blind.maxchanends, 1
|
|
.set write_sswitch_reg_blind.maxtimers, 0
|
|
.set write_sswitch_reg_blind.maxcores, 0
|