head.S
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:22k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  arch/s390/kernel/head.S
  3.  *
  4.  *  S390 version
  5.  *    Copyright (C) 1999,2000 IBM Deutschland Entwicklung GmbH, IBM Corporation
  6.  *    Author(s): Hartmut Penner (hp@de.ibm.com),
  7.  *               Martin Schwidefsky (schwidefsky@de.ibm.com),
  8.  *               Rob van der Heij (rvdhei@iae.nl)
  9.  *
  10.  * There are 5 different IPL methods
  11.  *  1) load the image directly into ram at address 0 and do an PSW restart
  12.  *  2) linload will load the image from address 0x10000 to memory 0x10000
  13.  *     and start the code thru LPSW 0x0008000080010000 (VM only, deprecated)
  14.  *  3) generate the tape ipl header, store the generated image on a tape
  15.  *     and ipl from it
  16.  *     In case of SL tape you need to IPL 5 times to get past VOL1 etc
  17.  *  4) generate the vm reader ipl header, move the generated image to the
  18.  *     VM reader (use option NOH!) and do a ipl from reader (VM only)
  19.  *  5) direct call of start by the SALIPL loader
  20.  *  We use the cpuid to distinguish between VM and native ipl
  21.  *  params for kernel are pushed to 0x10400 (see setup.h)
  22.     Changes: 
  23.     Okt 25 2000 <rvdheij@iae.nl>
  24. added code to skip HDR and EOF to allow SL tape IPL (5 retries)
  25. changed first CCW from rewind to backspace block
  26.  */
  27. #include <linux/config.h>
  28. #include <asm/setup.h>
  29. #include <asm/lowcore.h>
  30. #ifndef CONFIG_IPL
  31.         .org   0
  32.         .long  0x00080000,0x80000000+startup   # Just a restart PSW
  33. #else
  34. #ifdef CONFIG_IPL_TAPE
  35. #define IPL_BS 1024
  36.         .org   0
  37.         .long  0x00080000,0x80000000+iplstart  # The first 24 bytes are loaded
  38.         .long  0x27000000,0x60000001           # by ipl to addresses 0-23.
  39.         .long  0x02000000,0x20000000+IPL_BS    # (a PSW and two CCWs).
  40.         .long  0x00000000,0x00000000           # external old psw
  41.         .long  0x00000000,0x00000000           # svc old psw
  42.         .long  0x00000000,0x00000000           # program check old psw
  43.         .long  0x00000000,0x00000000           # machine check old psw
  44.         .long  0x00000000,0x00000000           # io old psw
  45.         .long  0x00000000,0x00000000
  46.         .long  0x00000000,0x00000000
  47.         .long  0x00000000,0x00000000
  48.         .long  0x000a0000,0x00000058           # external new psw
  49.         .long  0x000a0000,0x00000060           # svc new psw
  50.         .long  0x000a0000,0x00000068           # program check new psw
  51.         .long  0x000a0000,0x00000070           # machine check new psw
  52.         .long  0x00080000,0x80000000+.Lioint   # io new psw
  53.         .org   0x100
  54. #
  55. # subroutine for loading from tape
  56. # Paramters:
  57. #  R1 = device number
  58. #  R2 = load address
  59. .Lloader:
  60.         st    %r14,.Lldret
  61.         la    %r3,.Lorbread                    # r3 = address of orb 
  62. la    %r5,.Lirb                        # r5 = address of irb
  63.         st    %r2,.Lccwread+4                  # initialize CCW data addresses
  64.         lctl  %c6,%c6,.Lcr6               
  65.         slr   %r2,%r2
  66. .Lldlp:
  67.         la    %r6,3                            # 3 retries
  68. .Lssch:
  69.         ssch  0(%r3)                           # load chunk of IPL_BS bytes
  70.         bnz   .Llderr
  71. .Lw4end:
  72.         bas   %r14,.Lwait4io
  73.         tm    8(%r5),0x82                      # do we have a problem ?
  74.         bnz   .Lrecov
  75.         slr   %r7,%r7
  76.         icm   %r7,3,10(%r5)                    # get residual count
  77.         lcr   %r7,%r7
  78.         la    %r7,IPL_BS(%r7)                  # IPL_BS-residual=#bytes read
  79.         ar    %r2,%r7                          # add to total size
  80.         tm    8(%r5),0x01                      # found a tape mark ?
  81.         bnz   .Ldone
  82.         l     %r0,.Lccwread+4                  # update CCW data addresses
  83.         ar    %r0,%r7
  84.         st    %r0,.Lccwread+4                
  85.         b     .Lldlp
  86. .Ldone:
  87.         l     %r14,.Lldret
  88.         br    %r14                             # r2 contains the total size
  89. .Lrecov:
  90.         bas   %r14,.Lsense                     # do the sensing
  91.         bct   %r6,.Lssch                       # dec. retry count & branch
  92.         b     .Llderr
  93. #
  94. # Sense subroutine
  95. #
  96. .Lsense:
  97.         st    %r14,.Lsnsret
  98.         la    %r7,.Lorbsense              
  99.         ssch  0(%r7)                           # start sense command
  100.         bnz   .Llderr
  101.         bas   %r14,.Lwait4io
  102.         l     %r14,.Lsnsret
  103.         tm    8(%r5),0x82                      # do we have a problem ?
  104.         bnz   .Llderr
  105.         br    %r14
  106. #
  107. # Wait for interrupt subroutine
  108. #
  109. .Lwait4io:
  110.         lpsw  .Lwaitpsw                 
  111. .Lioint:
  112.         c     %r1,0xb8                         # compare subchannel number
  113.         bne   .Lwait4io
  114.         tsch  0(%r5)
  115.         slr   %r0,%r0
  116.         tm    8(%r5),0x82                      # do we have a problem ?
  117.         bnz   .Lwtexit
  118.         tm    8(%r5),0x04                      # got device end ?
  119.         bz    .Lwait4io
  120. .Lwtexit:
  121.         br    %r14
  122. .Llderr:
  123.         lpsw  .Lcrash              
  124.         .align 8
  125. .Lorbread:
  126. .long  0x00000000,0x0080ff00,.Lccwread
  127.         .align 8
  128. .Lorbsense:
  129.         .long  0x00000000,0x0080ff00,.Lccwsense
  130.         .align 8
  131. .Lccwread:
  132.         .long  0x02200000+IPL_BS,0x00000000
  133. .Lccwsense:
  134.         .long  0x04200001,0x00000000
  135. .Lwaitpsw:
  136. .long  0x020a0000,0x80000000+.Lioint
  137. .Lirb: .long  0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
  138. .Lcr6:  .long  0xff000000
  139.         .align 8
  140. .Lcrash:.long  0x000a0000,0x00000000
  141. .Lldret:.long  0
  142. .Lsnsret: .long 0
  143. #endif  /* CONFIG_IPL_TAPE */
  144. #ifdef CONFIG_IPL_VM
  145. #define IPL_BS 0x730
  146.         .org   0
  147.         .long  0x00080000,0x80000000+iplstart  # The first 24 bytes are loaded
  148.         .long  0x02000018,0x60000050           # by ipl to addresses 0-23.
  149.         .long  0x02000068,0x60000050           # (a PSW and two CCWs).
  150.         .fill  80-24,1,0x40                    # bytes 24-79 are discarded !!
  151.         .long  0x020000f0,0x60000050           # The next 160 byte are loaded
  152.         .long  0x02000140,0x60000050           # to addresses 0x18-0xb7
  153.         .long  0x02000190,0x60000050           # They form the continuation
  154.         .long  0x020001e0,0x60000050           # of the CCW program started
  155.         .long  0x02000230,0x60000050           # by ipl and load the range
  156.         .long  0x02000280,0x60000050           # 0x0f0-0x730 from the image
  157.         .long  0x020002d0,0x60000050           # to the range 0x0f0-0x730
  158.         .long  0x02000320,0x60000050           # in memory. At the end of
  159.         .long  0x02000370,0x60000050           # the channel program the PSW
  160.         .long  0x020003c0,0x60000050           # at location 0 is loaded.
  161.         .long  0x02000410,0x60000050           # Initial processing starts
  162.         .long  0x02000460,0x60000050           # at 0xf0 = iplstart.
  163.         .long  0x020004b0,0x60000050
  164.         .long  0x02000500,0x60000050
  165.         .long  0x02000550,0x60000050
  166.         .long  0x020005a0,0x60000050
  167.         .long  0x020005f0,0x60000050
  168.         .long  0x02000640,0x60000050
  169.         .long  0x02000690,0x60000050
  170.         .long  0x020006e0,0x20000050
  171.         .org   0xf0
  172. #
  173. # subroutine for loading cards from the reader
  174. #
  175. .Lloader:
  176. la    %r3,.Lorb                        # r2 = address of orb into r2
  177. la    %r5,.Lirb                        # r4 = address of irb
  178.         la    %r6,.Lccws              
  179.         la    %r7,20
  180. .Linit:
  181.         st    %r2,4(%r6)                       # initialize CCW data addresses
  182.         la    %r2,0x50(%r2)
  183.         la    %r6,8(%r6)
  184.         bct   7,.Linit
  185.         lctl  %c6,%c6,.Lcr6                    # set IO subclass mask
  186. slr   %r2,%r2
  187. .Lldlp:
  188.         ssch  0(%r3)                           # load chunk of 1600 bytes
  189.         bnz   .Llderr
  190. .Lwait4irq:
  191.         mvc   0x78(8),.Lnewpsw                 # set up IO interrupt psw
  192.         lpsw  .Lwaitpsw              
  193. .Lioint:
  194.         c     %r1,0xb8                         # compare subchannel number
  195. bne   .Lwait4irq
  196. tsch  0(%r5)
  197. slr   %r0,%r0
  198. ic    %r0,8(%r5)                       # get device status
  199. chi   %r0,8                            # channel end ?
  200. be    .Lcont
  201. chi   %r0,12                           # channel end + device end ?
  202. be    .Lcont
  203.         l     %r0,4(%r5)
  204.         s     %r0,8(%r3)                       # r0/8 = number of ccws executed
  205.         mhi   %r0,10                           # *10 = number of bytes in ccws
  206.         lh    %r3,10(%r5)                      # get residual count
  207.         sr    %r0,%r3                          # #ccws*80-residual=#bytes read
  208. ar    %r2,%r0
  209.         br    %r14                             # r2 contains the total size
  210. .Lcont:
  211. ahi   %r2,0x640                        # add 0x640 to total size
  212.         la    %r6,.Lccws             
  213.         la    %r7,20
  214. .Lincr:
  215.         l     %r0,4(%r6)                       # update CCW data addresses
  216.         ahi   %r0,0x640
  217.         st    %r0,4(%r6)
  218.         ahi   %r6,8
  219.         bct   7,.Lincr
  220.         b     .Lldlp
  221. .Llderr:
  222.         lpsw  .Lcrash              
  223.         .align 8
  224. .Lorb: .long  0x00000000,0x0080ff00,.Lccws
  225. .Lirb: .long  0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
  226. .Lcr6:  .long  0xff000000
  227. .Lloadp:.long  0,0
  228.         .align 8
  229. .Lcrash:.long  0x000a0000,0x00000000
  230. .Lnewpsw:
  231.         .long  0x00080000,0x80000000+.Lioint
  232. .Lwaitpsw:
  233.         .long  0x020a0000,0x80000000+.Lioint
  234.         .align 8
  235. .Lccws: .rept  19
  236.         .long  0x02600050,0x00000000
  237.         .endr
  238.         .long  0x02200050,0x00000000
  239. #endif  /* CONFIG_IPL_VM */
  240. iplstart:
  241.         lh    %r1,0xb8                         # test if subchannel number
  242.         bct   %r1,.Lnoload                     #  is valid
  243. l     %r1,0xb8                         # load ipl subchannel number
  244.         la    %r2,IPL_BS                       # load start address
  245.         bas   %r14,.Lloader                    # load rest of ipl image
  246.         larl  %r12,_pstart                     # pointer to parameter area
  247.         st    %r1,IPL_DEVICE+4-PARMAREA(%r12)  # store ipl device number
  248. #
  249. # load parameter file from ipl device
  250. #
  251. .Lagain1:
  252.   l     %r2,INITRD_START+4-PARMAREA(%r12)# use ramdisk location as temp
  253.         bas   %r14,.Lloader                    # load parameter file
  254.         ltr   %r2,%r2                          # got anything ?
  255.         bz    .Lnopf
  256. chi   %r2,895
  257. bnh   .Lnotrunc
  258. la    %r2,895
  259. .Lnotrunc:
  260. l     %r4,INITRD_START+4-PARMAREA(%r12)
  261.   clc   0(3,%r4),.L_hdr        # if it is HDRx
  262.   bz    .Lagain1        # skip dataset header
  263.   clc   0(3,%r4),.L_eof        # if it is EOFx
  264.   bz    .Lagain1        # skip dateset trailer
  265.         la    %r5,0(%r4,%r2)
  266.         lr    %r3,%r2
  267. .Lidebc:
  268.         tm    0(%r5),0x80                      # high order bit set ?
  269.         bo    .Ldocv                           #  yes -> convert from EBCDIC
  270.         ahi   %r5,-1
  271.         bct   %r3,.Lidebc
  272.         b     .Lnocv
  273. .Ldocv:
  274.         l     %r3,.Lcvtab
  275.         tr    0(256,%r4),0(%r3)                # convert parameters to ascii
  276.         tr    256(256,%r4),0(%r3)
  277.         tr    512(256,%r4),0(%r3)
  278.         tr    768(122,%r4),0(%r3)
  279. .Lnocv: la    %r3,COMMAND_LINE-PARMAREA(%r12)  # load adr. of command line
  280. mvc   0(256,%r3),0(%r4)
  281. mvc   256(256,%r3),256(%r4)
  282. mvc   512(256,%r3),512(%r4)
  283. mvc   768(122,%r3),768(%r4)
  284.         slr   %r0,%r0
  285.         b     .Lcntlp
  286. .Ldelspc:
  287.         ic    %r0,0(%r2,%r3)
  288.         chi   %r0,0x20                         # is it a space ?
  289.         be    .Lcntlp
  290.         ahi   %r2,1
  291.         b     .Leolp
  292. .Lcntlp:
  293.         brct  %r2,.Ldelspc
  294. .Leolp:
  295.         slr   %r0,%r0
  296.         stc   %r0,0(%r2,%r3)                   # terminate buffer
  297. .Lnopf:
  298. #
  299. # load ramdisk from ipl device
  300. #
  301. .Lagain2:
  302.   l     %r2,INITRD_START+4-PARMAREA(%r12)# load adr. of ramdisk
  303.         bas   %r14,.Lloader                    # load ramdisk
  304.   st    %r2,INITRD_SIZE+4-PARMAREA(%r12) # store size of ramdisk
  305.         ltr   %r2,%r2
  306.         bnz   .Lrdcont
  307.         st    %r2,INITRD_START+4-PARMAREA(%r12)# no ramdisk found, null it
  308. .Lrdcont:
  309. l     %r2,INITRD_START-PARMAREA(%r12)
  310. clc   0(3,%r2),.L_hdr        # skip HDRx and EOFx 
  311. bz    .Lagain2
  312. clc   0(3,%r2),.L_eof
  313. bz    .Lagain2
  314. #ifdef CONFIG_IPL_VM
  315. #
  316. # reset files in VM reader
  317. #
  318.         stidp __LC_CPUID                       # store cpuid
  319. tm    __LC_CPUID,0xff                  # running VM ?
  320. bno   .Lnoreset
  321.         la    %r2,.Lreset              
  322.         lhi   %r3,26
  323.         .long 0x83230008
  324. .Lnoreset:
  325. #endif
  326. #
  327. # everything loaded, go for it
  328. #
  329. .Lnoload:
  330.         l     %r1,.Lstartup
  331.         br    %r1
  332. .Lstartup: .long startup
  333. .Lcvtab:.long  _ebcasc                         # ebcdic to ascii table
  334. .Lreset:.byte  0xc3,0xc8,0xc1,0xd5,0xc7,0xc5,0x40,0xd9,0xc4,0xd9,0x40
  335.         .byte  0xc1,0xd3,0xd3,0x40,0xd2,0xc5,0xc5,0xd7,0x40,0xd5,0xd6
  336.         .byte  0xc8,0xd6,0xd3,0xc4             # "change rdr all keep nohold"
  337. .L_eof: .long  0xc5d6c600       /* C'EOF' */
  338. .L_hdr: .long  0xc8c4d900       /* C'HDR' */
  339. #endif  /* CONFIG_IPL */
  340. #
  341. # SALIPL loader support. Based on a patch by Rob van der Heij.
  342. # This entry point is called directly from the SALIPL loader and
  343. # doesn't need a builtin ipl record.
  344. #
  345.         .org  0x800
  346. .globl start
  347. start:
  348. stm   %r0,%r15,0x07b0 # store registers
  349. basr  %r12,%r0
  350. .base:
  351. l     %r11,.parm
  352. l     %r8,.cmd # pointer to command buffer
  353. ltr   %r9,%r9 # do we have SALIPL parameters?
  354. bp    .sk8x8
  355. mvc   0(64,%r8),0x00b0 # copy saved registers
  356. xc    64(240-64,%r8),0(%r8) # remainder of buffer
  357. tr    0(64,%r8),.lowcase
  358. b     .gotr
  359. .sk8x8:
  360. mvc   0(240,%r8),0(%r9) # copy iplparms into buffer
  361. .gotr:
  362. l     %r10,.tbl # EBCDIC to ASCII table
  363. tr    0(240,%r8),0(%r10)
  364. stidp __LC_CPUID # Are we running on VM maybe
  365. cli   __LC_CPUID,0xff
  366. bnz   .test
  367. .long 0x83300060 # diag 3,0,x'0060' - storage size
  368. b     .done
  369. .test:
  370. mvc   0x68(8),.pgmnw # set up pgm check handler
  371. l     %r2,.fourmeg
  372. lr    %r3,%r2
  373. bctr  %r3,%r0 # 4M-1
  374. .loop:  iske  %r0,%r3
  375. ar    %r3,%r2
  376. .pgmx:
  377. sr    %r3,%r2
  378. la    %r3,1(%r3)
  379. .done:
  380. l     %r1,.memsize
  381. st    %r3,4(%r1)
  382. slr   %r0,%r0
  383. st    %r0,INITRD_SIZE+4-PARMAREA(%r11)
  384. st    %r0,INITRD_START+4-PARMAREA(%r11)
  385. j     startup                   # continue with startup
  386. .tbl: .long _ebcasc # translate table
  387. .cmd: .long COMMAND_LINE # address of command line buffer
  388. .parm: .long PARMAREA
  389. .fourmeg: .long 0x00400000       # 4M
  390. .pgmnw: .long 0x00080000,.pgmx
  391. .memsize: .long memory_size
  392. .lowcase:
  393. .byte 0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07 
  394. .byte 0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f
  395. .byte 0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17 
  396. .byte 0x18,0x19,0x1a,0x1b,0x1c,0x1d,0x1e,0x1f
  397. .byte 0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27 
  398. .byte 0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f
  399. .byte 0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37 
  400. .byte 0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f
  401. .byte 0x40,0x41,0x42,0x43,0x44,0x45,0x46,0x47 
  402. .byte 0x48,0x49,0x4a,0x4b,0x4c,0x4d,0x4e,0x4f
  403. .byte 0x50,0x51,0x52,0x53,0x54,0x55,0x56,0x57 
  404. .byte 0x58,0x59,0x5a,0x5b,0x5c,0x5d,0x5e,0x5f
  405. .byte 0x60,0x61,0x62,0x63,0x64,0x65,0x66,0x67 
  406. .byte 0x68,0x69,0x6a,0x6b,0x6c,0x6d,0x6e,0x6f
  407. .byte 0x70,0x71,0x72,0x73,0x74,0x75,0x76,0x77 
  408. .byte 0x78,0x79,0x7a,0x7b,0x7c,0x7d,0x7e,0x7f
  409. .byte 0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87 
  410. .byte 0x88,0x89,0x8a,0x8b,0x8c,0x8d,0x8e,0x8f
  411. .byte 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97 
  412. .byte 0x98,0x99,0x9a,0x9b,0x9c,0x9d,0x9e,0x9f
  413. .byte 0xa0,0xa1,0xa2,0xa3,0xa4,0xa5,0xa6,0xa7 
  414. .byte 0xa8,0xa9,0xaa,0xab,0xac,0xad,0xae,0xaf
  415. .byte 0xb0,0xb1,0xb2,0xb3,0xb4,0xb5,0xb6,0xb7 
  416. .byte 0xb8,0xb9,0xba,0xbb,0xbc,0xbd,0xbe,0xbf
  417. .byte 0xc0,0x81,0x82,0x83,0x84,0x85,0x86,0x87 # .abcdefg 
  418. .byte 0x88,0x89,0xca,0xcb,0xcc,0xcd,0xce,0xcf # hi
  419. .byte 0xd0,0x91,0x92,0x93,0x94,0x95,0x96,0x97  # .jklmnop
  420. .byte 0x98,0x99,0xda,0xdb,0xdc,0xdd,0xde,0xdf # qr
  421. .byte 0xe0,0xe1,0xa2,0xa3,0xa4,0xa5,0xa6,0xa7 # ..stuvwx
  422. .byte 0xa8,0xa9,0xea,0xeb,0xec,0xed,0xee,0xef # yz
  423. .byte 0xf0,0xf1,0xf2,0xf3,0xf4,0xf5,0xf6,0xf7 
  424. .byte 0xf8,0xf9,0xfa,0xfb,0xfc,0xfd,0xfe,0xff
  425. #
  426. # startup-code at 0x10000, running in real mode
  427. # this is called either by the ipl loader or directly by PSW restart
  428. # or linload or SALIPL
  429. #
  430.         .org  0x10000
  431. startup:basr  %r13,0                     # get base
  432. .LPG1:  sll   %r13,1                     # remove high order bit
  433.         srl   %r13,1
  434.         lhi   %r1,1                      # mode 1 = esame
  435.         slr   %r0,%r0                    # set cpuid to zero
  436.         sigp  %r1,%r0,0x12               # switch to esame mode
  437. sam64  # switch to 64 bit mode
  438. lctlg %c0,%c15,.Lctl-.LPG1(%r13) # load control registers
  439. larl  %r12,_pstart               # pointer to parameter area
  440.  # move IPL device to lowcore
  441.         mvc   __LC_IPLDEV(4),IPL_DEVICE+4-PARMAREA(%r12)
  442.  # set program check new psw mask
  443. mvc   __LC_PGM_NEW_PSW(8),.Lpcmsk-.LPG1(%r13)
  444. #
  445. # find memory chunks.
  446. #
  447. larl  %r1,.Lchkmem               # set program check address
  448. stg   %r1,__LC_PGM_NEW_PSW+8
  449. la    %r1,1                      # test in increments of 128KB
  450. sllg  %r1,%r1,17
  451. larl  %r3,memory_chunk
  452. slgr  %r4,%r4                    # set start of chunk to zero
  453. slgr  %r5,%r5                    # set end of chunk to zero
  454. slr  %r6,%r6  # set access code to zero
  455. .Lloop:
  456. tprot 0(%r5),0  # test protection of first byte
  457. ipm   %r7
  458. srl   %r7,28
  459. clr   %r6,%r7  # compare cc with last access code
  460. je    .Lsame
  461. clgr  %r4,%r5  # chunk size > 0?
  462. je    .Lsize0
  463. stg   %r4,0(%r3)  # store start address of chunk
  464. lgr   %r0,%r5
  465. slgr  %r0,%r4
  466. stg   %r0,8(%r3)  # store size of chunk
  467. st    %r6,20(%r3)  # store type of chunk
  468. la    %r3,24(%r3)
  469. lgr   %r4,%r5  # set start to end
  470. larl  %r8,memory_size
  471. stg   %r5,0(%r8)                 # store memory size
  472. .Lsize0:
  473. lr    %r6,%r7  # set access code to last cc
  474. .Lsame:
  475. algr  %r5,%r1  # add 128KB to end of chunk
  476. brc   12,.Lloop
  477. .Lchkmem:  # > 16EB or tprot got a program check
  478. clgr  %r4,%r5  # chunk size > 0?
  479. je    .Ldonemem
  480. stg   %r4,0(%r3)  # store start address of chunk
  481. lgr   %r0,%r5
  482. slgr  %r0,%r4
  483. stg   %r0,8(%r3)  # store size of chunk
  484. st    %r6,20(%r3)  # store type of chunk
  485. la    %r3,24(%r3)
  486. lgr   %r4,%r5
  487. larl  %r8,memory_size
  488. stg   %r5,0(%r8)                 # store memory size
  489. #
  490. # Running native the HSA is located at 2GB and we will get an
  491. # addressing exception trying to access it. We have to restart
  492. # the scan at 2GB to find out if the machine has more than 2GB.
  493. #
  494. lghi  %r4,1
  495. sllg  %r4,%r4,31
  496. clgr  %r5,%r4
  497. jhe   .Ldonemem
  498. lgr   %r5,%r4
  499. j     .Lloop
  500. .Ldonemem:
  501. larl  %r12,machine_flags
  502. #
  503. # find out if we are running under VM
  504. #
  505.         stidp  __LC_CPUID               # store cpuid
  506. tm     __LC_CPUID,0xff          # running under VM ?
  507. bno    0f-.LPG1(%r13)
  508.         oi     7(%r12),1                # set VM flag
  509. 0:      lh     %r0,__LC_CPUID+4         # get cpu version
  510.         chi    %r0,0x7490               # running on a P/390 ?
  511.         bne    1f-.LPG1(%r13)
  512.         oi     7(%r12),4                # set P/390 flag
  513. 1:
  514. #
  515. # find out if we have the MVPG instruction
  516. #
  517. la     %r1,0f-.LPG1(%r13)       # set program check address
  518. stg    %r1,__LC_PGM_NEW_PSW+8
  519. sgr    %r0,%r0
  520. lghi   %r1,0
  521. lghi   %r2,0
  522. mvpg   %r1,%r2                  # test MVPG instruction
  523. oi     7(%r12),16               # set MVPG flag
  524. 0:
  525.         lpswe .Lentry-.LPG1(13)         # jump to _stext in primary-space,
  526.                                         # virtual and never return ...
  527.         .align 16
  528. .Lentry:.quad  0x0000000180000000,_stext
  529. .Lctl:  .quad  0x04b50002               # cr0: various things
  530.         .quad  0                        # cr1: primary space segment table
  531.         .quad  .Lduct                   # cr2: dispatchable unit control table
  532.         .quad  0                        # cr3: instruction authorization
  533.         .quad  0                        # cr4: instruction authorization
  534.         .quad  0                        # cr5:  various things
  535.         .quad  0                        # cr6:  I/O interrupts
  536.         .quad  0                        # cr7:  secondary space segment table
  537.         .quad  0                        # cr8:  access registers translation
  538.         .quad  0                        # cr9:  tracing off
  539.         .quad  0                        # cr10: tracing off
  540.         .quad  0                        # cr11: tracing off
  541.         .quad  0                        # cr12: tracing off
  542.         .quad  0                        # cr13: home space segment table
  543.         .quad  0xc0000000               # cr14: machine check handling off
  544.         .quad  0                        # cr15: linkage stack operations
  545. .Lpcmsk:.quad  0x0000000180000000
  546. .L4malign:.quad 0xffffffffffc00000
  547. .Lscan2g:.quad 0x80000000 + 0x20000 - 8 # 2GB + 128K - 8
  548. .org PARMAREA-64
  549. .Lduct: .long 0,0,0,0,0,0,0,0
  550. .long 0,0,0,0,0,0,0,0
  551. #
  552. # params at 10400 (setup.h)
  553. #
  554. .org   PARMAREA
  555. .global _pstart
  556. _pstart:
  557. .quad  0                        # IPL_DEVICE
  558.         .quad  RAMDISK_ORIGIN           # INITRD_START
  559.         .quad  RAMDISK_SIZE             # INITRD_SIZE
  560.         .org   COMMAND_LINE
  561.      .byte  "root=/dev/ram0 ro"
  562.         .byte  0
  563. .org   0x11000
  564. .global _pend
  565. _pend:
  566. #ifdef CONFIG_SHARED_KERNEL
  567. .org   0x100000
  568. #endif
  569. #
  570. # startup-code, running in virtual mode
  571. #
  572.         .globl _stext
  573. _stext: basr  %r13,0                    # get base
  574. .LPG2:
  575. #
  576. # Setup stack
  577. #
  578. larl  %r15,init_task_union
  579.         aghi  %r15,16384                # init_task_union + 16384
  580.         stg   %r15,__LC_KERNEL_STACK    # set end of kernel stack
  581.         aghi  %r15,-160
  582.         xc    0(8,%r15),0(%r15)         # set backchain to zero
  583. #
  584. # clear bss memory
  585. #
  586. larl  %r2,__bss_start           # start of bss segment
  587.         larl  %r3,_end                  # end of bss segment
  588.         sgr   %r3,%r2                   # length of bss
  589.         sgr   %r4,%r4                   #
  590.         sgr   %r5,%r5                   # set src,length and pad to zero
  591.         mvcle %r2,%r4,0                 # clear mem
  592.         jo    .-4                       # branch back, if not finish
  593. # check control registers
  594.         stctg  %c0,%c15,0(%r15)
  595. oi     6(%r15),0x20             # enable sigp external interrupts
  596. oi     4(%r15),0x10             # switch on low address proctection
  597.         lctlg  %c0,%c15,0(%r15)
  598. #
  599.         lam    0,15,.Laregs-.LPG2(%r13) # load access regs needed by uaccess
  600.         brasl  %r14,start_kernel        # go to C code
  601. #
  602. # We returned from start_kernel ?!? PANIK
  603. #
  604.         basr  %r13,0
  605. lpswe .Ldw-.(%r13)           # load disabled wait psw
  606. #
  607.             .align 8
  608. .Ldw:       .quad  0x0002000180000000,0x0000000000000000
  609. .Laregs:    .long  0,0,0,0,1,0,0,0,0,0,0,0,0,0,0,0