Blame view

kernel/linux-rt-4.4.41/arch/alpha/lib/callback_srm.S 2.77 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
  /*
   *	arch/alpha/lib/callback_srm.S
   */
  
  #include <asm/console.h>
  
  .text
  #define HWRPB_CRB_OFFSET 0xc0
  
  #if defined(CONFIG_ALPHA_SRM) || defined(CONFIG_ALPHA_GENERIC)
  .align 4
  srm_dispatch:
  #if defined(CONFIG_ALPHA_GENERIC)
  	ldl	$4,alpha_using_srm
  	beq	$4,nosrm
  #endif
  	ldq	$0,hwrpb	# gp is set up by CALLBACK macro.
  	ldl	$25,0($25)	# Pick up the wrapper data.
  	mov	$20,$21		# Shift arguments right.
  	mov	$19,$20
  	ldq	$1,HWRPB_CRB_OFFSET($0)
  	mov	$18,$19
  	mov	$17,$18
  	mov	$16,$17
  	addq	$0,$1,$2	# CRB address
  	ldq	$27,0($2)	# DISPATCH procedure descriptor (VMS call std)
  	extwl	$25,0,$16	# SRM callback function code
  	ldq	$3,8($27)	# call address
  	extwl	$25,2,$25	# argument information (VMS calling std)
  	jmp	($3)		# Return directly to caller of wrapper.
  
  .align 4
  .globl	srm_fixup
  .ent	srm_fixup
  srm_fixup:
  	ldgp	$29,0($27)
  #if defined(CONFIG_ALPHA_GENERIC)
  	ldl	$4,alpha_using_srm
  	beq	$4,nosrm
  #endif
  	ldq	$0,hwrpb
  	ldq	$1,HWRPB_CRB_OFFSET($0)
  	addq	$0,$1,$2	# CRB address
  	ldq	$27,16($2)	# VA of FIXUP procedure descriptor
  	ldq	$3,8($27)	# call address
  	lda	$25,2($31)	# two integer arguments
  	jmp	($3)		# Return directly to caller of srm_fixup.
  .end    srm_fixup
  
  #if defined(CONFIG_ALPHA_GENERIC)
  .align 3
  nosrm:
  	lda	$0,-1($31)
  	ret
  #endif
  
  #define CALLBACK(NAME, CODE, ARG_CNT) \
  .align 4; .globl callback_##NAME; .ent callback_##NAME; callback_##NAME##: \
  ldgp $29,0($27); br $25,srm_dispatch; .word CODE, ARG_CNT; .end callback_##NAME
  
  #else /* defined(CONFIG_ALPHA_SRM) || defined(CONFIG_ALPHA_GENERIC) */
  
  #define CALLBACK(NAME, CODE, ARG_CNT) \
  .align 3; .globl callback_##NAME; .ent callback_##NAME; callback_##NAME##: \
  lda $0,-1($31); ret; .end callback_##NAME
  
  .align 3
  .globl	srm_fixup
  .ent	srm_fixup
  srm_fixup:
  	lda	$0,-1($31)
  	ret
  .end	srm_fixup
  #endif /* defined(CONFIG_ALPHA_SRM) || defined(CONFIG_ALPHA_GENERIC) */
  
  CALLBACK(puts, CCB_PUTS, 4)
  CALLBACK(open, CCB_OPEN, 3)
  CALLBACK(close, CCB_CLOSE, 2)
  CALLBACK(read, CCB_READ, 5)
  CALLBACK(open_console, CCB_OPEN_CONSOLE, 1)
  CALLBACK(close_console, CCB_CLOSE_CONSOLE, 1)
  CALLBACK(getenv, CCB_GET_ENV, 4)
  CALLBACK(setenv, CCB_SET_ENV, 4)
  CALLBACK(getc, CCB_GETC, 2)
  CALLBACK(reset_term, CCB_RESET_TERM, 2)
  CALLBACK(term_int, CCB_SET_TERM_INT, 3)
  CALLBACK(term_ctl, CCB_SET_TERM_CTL, 3)
  CALLBACK(process_keycode, CCB_PROCESS_KEYCODE, 3)
  CALLBACK(ioctl, CCB_IOCTL, 6)
  CALLBACK(write, CCB_WRITE, 5)
  CALLBACK(reset_env, CCB_RESET_ENV, 4)
  CALLBACK(save_env, CCB_SAVE_ENV, 1)
  CALLBACK(pswitch, CCB_PSWITCH, 3)
  CALLBACK(bios_emul, CCB_BIOS_EMUL, 5)
  	
  .data
  __alpha_using_srm:		# For use by bootpheader
  	.long 7			# value is not 1 for link debugging
  	.weak alpha_using_srm; alpha_using_srm = __alpha_using_srm
  __callback_init_done:		# For use by bootpheader
  	.long 7			# value is not 1 for link debugging
  	.weak callback_init_done; callback_init_done = __callback_init_done