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   __LC_IO_NEW_PSW(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.         l     %r12,.Lparm                      # pointer to parameter area
  247.         st    %r1,IPL_DEVICE-PARMAREA(%r12)    # store ipl device number
  248. #
  249. # load parameter file from ipl device
  250. #
  251. .Lagain1:
  252.   l     %r2,INITRD_START-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-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-PARMAREA(%r12)  # load adr. of ramdisk
  303.         bas   %r14,.Lloader                    # load ramdisk
  304.   st    %r2,INITRD_SIZE-PARMAREA(%r12)   # store size of ramdisk
  305.         ltr   %r2,%r2
  306.         bnz   .Lrdcont
  307.         st    %r2,INITRD_START-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. .Lparm: .long  PARMAREA
  333. .Lstartup: .long startup
  334. .Lcvtab:.long  _ebcasc                         # ebcdic to ascii table
  335. .Lreset:.byte  0xc3,0xc8,0xc1,0xd5,0xc7,0xc5,0x40,0xd9,0xc4,0xd9,0x40
  336.         .byte  0xc1,0xd3,0xd3,0x40,0xd2,0xc5,0xc5,0xd7,0x40,0xd5,0xd6
  337.         .byte  0xc8,0xd6,0xd3,0xc4             # "change rdr all keep nohold"
  338. .L_eof: .long  0xc5d6c600       /* C'EOF' */
  339. .L_hdr: .long  0xc8c4d900       /* C'HDR' */
  340. #endif  /* CONFIG_IPL */
  341. #
  342. # SALIPL loader support. Based on a patch by Rob van der Heij.
  343. # This entry point is called directly from the SALIPL loader and
  344. # doesn't need a builtin ipl record.
  345. #
  346.         .org  0x800
  347. .globl start
  348. start:
  349. stm   %r0,%r15,0x07b0 # store registers
  350. basr  %r12,%r0
  351. .base:
  352. l     %r11,.parm
  353. l     %r8,.cmd # pointer to command buffer
  354. ltr   %r9,%r9 # do we have SALIPL parameters?
  355. bp    .sk8x8
  356. mvc   0(64,%r8),0x00b0 # copy saved registers
  357. xc    64(240-64,%r8),0(%r8) # remainder of buffer
  358. tr    0(64,%r8),.lowcase
  359. b     .gotr
  360. .sk8x8:
  361. mvc   0(240,%r8),0(%r9) # copy iplparms into buffer
  362. .gotr:
  363. l     %r10,.tbl # EBCDIC to ASCII table
  364. tr    0(240,%r8),0(%r10)
  365. stidp __LC_CPUID # Are we running on VM maybe
  366. cli   __LC_CPUID,0xff
  367. bnz   .test
  368. .long 0x83300060 # diag 3,0,x'0060' - storage size
  369. b     .done
  370. .test:
  371. mvc   0x68(8),.pgmnw # set up pgm check handler
  372. l     %r2,.fourmeg
  373. lr    %r3,%r2
  374. bctr  %r3,%r0 # 4M-1
  375. .loop:  iske  %r0,%r3
  376. ar    %r3,%r2
  377. .pgmx:
  378. sr    %r3,%r2
  379. la    %r3,1(%r3)
  380. .done:
  381.         l     %r1,.memsize
  382. st    %r3,0(%r1)
  383. slr   %r0,%r0
  384. st    %r0,INITRD_SIZE-PARMAREA(%r11)
  385. st    %r0,INITRD_START-PARMAREA(%r11)
  386. j     startup                   # continue with startup
  387. .tbl: .long _ebcasc # translate table
  388. .cmd: .long COMMAND_LINE # address of command line buffer
  389. .parm: .long PARMAREA
  390. .memsize: .long memory_size
  391. .fourmeg: .long 0x00400000       # 4M
  392. .pgmnw: .long 0x00080000,.pgmx
  393. .lowcase:
  394. .byte 0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07 
  395. .byte 0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f
  396. .byte 0x10,0x11,0x12,0x13,0x14,0x15,0x16,0x17 
  397. .byte 0x18,0x19,0x1a,0x1b,0x1c,0x1d,0x1e,0x1f
  398. .byte 0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27 
  399. .byte 0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f
  400. .byte 0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37 
  401. .byte 0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f
  402. .byte 0x40,0x41,0x42,0x43,0x44,0x45,0x46,0x47 
  403. .byte 0x48,0x49,0x4a,0x4b,0x4c,0x4d,0x4e,0x4f
  404. .byte 0x50,0x51,0x52,0x53,0x54,0x55,0x56,0x57 
  405. .byte 0x58,0x59,0x5a,0x5b,0x5c,0x5d,0x5e,0x5f
  406. .byte 0x60,0x61,0x62,0x63,0x64,0x65,0x66,0x67 
  407. .byte 0x68,0x69,0x6a,0x6b,0x6c,0x6d,0x6e,0x6f
  408. .byte 0x70,0x71,0x72,0x73,0x74,0x75,0x76,0x77 
  409. .byte 0x78,0x79,0x7a,0x7b,0x7c,0x7d,0x7e,0x7f
  410. .byte 0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87 
  411. .byte 0x88,0x89,0x8a,0x8b,0x8c,0x8d,0x8e,0x8f
  412. .byte 0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97 
  413. .byte 0x98,0x99,0x9a,0x9b,0x9c,0x9d,0x9e,0x9f
  414. .byte 0xa0,0xa1,0xa2,0xa3,0xa4,0xa5,0xa6,0xa7 
  415. .byte 0xa8,0xa9,0xaa,0xab,0xac,0xad,0xae,0xaf
  416. .byte 0xb0,0xb1,0xb2,0xb3,0xb4,0xb5,0xb6,0xb7 
  417. .byte 0xb8,0xb9,0xba,0xbb,0xbc,0xbd,0xbe,0xbf
  418. .byte 0xc0,0x81,0x82,0x83,0x84,0x85,0x86,0x87 # .abcdefg 
  419. .byte 0x88,0x89,0xca,0xcb,0xcc,0xcd,0xce,0xcf # hi
  420. .byte 0xd0,0x91,0x92,0x93,0x94,0x95,0x96,0x97  # .jklmnop
  421. .byte 0x98,0x99,0xda,0xdb,0xdc,0xdd,0xde,0xdf # qr
  422. .byte 0xe0,0xe1,0xa2,0xa3,0xa4,0xa5,0xa6,0xa7 # ..stuvwx
  423. .byte 0xa8,0xa9,0xea,0xeb,0xec,0xed,0xee,0xef # yz
  424. .byte 0xf0,0xf1,0xf2,0xf3,0xf4,0xf5,0xf6,0xf7 
  425. .byte 0xf8,0xf9,0xfa,0xfb,0xfc,0xfd,0xfe,0xff
  426. #
  427. # startup-code at 0x10000, running in real mode
  428. # this is called either by the ipl loader or directly by PSW restart
  429. # or linload or SALIPL
  430. #
  431.         .org  0x10000
  432. startup:basr  %r13,0                     # get base
  433. .LPG1:  lctl  %c0,%c15,.Lctl-.LPG1(%r13) # load control registers
  434. la    %r12,_pstart-.LPG1(%r13)   # pointer to parameter area
  435.  # move IPL device to lowcore
  436.         mvc   __LC_IPLDEV(4),IPL_DEVICE-PARMAREA(%r12)
  437. #
  438. # find memory chunks.
  439. #
  440. mvc   __LC_PGM_NEW_PSW(8),.Lpcmem-.LPG1(%r13)
  441. la    %r1,1                      # test in increments of 128KB
  442. sll   %r1,17
  443. l     %r3,.Lmchunk-.LPG1(%r13)   # get pointer to memory_chunk array
  444. slr   %r4,%r4                    # set start of chunk to zero
  445. slr   %r5,%r5                    # set end of chunk to zero
  446. slr   %r6,%r6  # set access code to zero
  447. .Lloop:
  448. tprot 0(%r5),0  # test protection of first byte
  449. ipm   %r7
  450. srl   %r7,28
  451. clr   %r6,%r7  # compare cc with last access code
  452. be    .Lsame-.LPG1(%r13)
  453. clr   %r4,%r5  # chunk size > 0?
  454. be    .Lsize0-.LPG1(%r13)
  455. st    %r4,0(%r3)  # store start address of chunk
  456. lr    %r0,%r5
  457. slr   %r0,%r4
  458. st    %r0,4(%r3)  # store size of chunk
  459. st    %r6,8(%r3)  # store type of chunk
  460. la    %r3,12(%r3)
  461. lr    %r4,%r5  # set start to end
  462. .Lsize0:
  463. lr    %r6,%r7  # set access code to last cc
  464. .Lsame:
  465. ar    %r5,%r1  # add 128KB to end of chunk
  466. bno   .Lloop-.LPG1(%r13)  # r1 < 0x80000000 -> loop
  467. .Lchkmem:  # > 2GB or tprot got a program check
  468. clr   %r4,%r5  # chunk size > 0?
  469. be    .Ldonemem-.LPG1(%r13)
  470. st    %r4,0(%r3)  # store start address of chunk
  471. lr    %r0,%r5
  472. slr   %r0,%r4
  473. st    %r0,4(%r3)  # store size of chunk
  474. st    %r6,8(%r3)  # store type of chunk
  475. .Ldonemem:
  476.         l     %r1,.Lmemsize-.LPG1(%r13)  # address of variable memory_size
  477. st    %r5,0(%r1)                 # store last end to memory size
  478.         l      %r12,.Lmflags-.LPG1(%r13) # get address of machine_flags
  479. #
  480. # find out if we are running under VM
  481. #
  482.         stidp  __LC_CPUID               # store cpuid
  483. tm     __LC_CPUID,0xff          # running under VM ?
  484. bno    .Lnovm-.LPG1(%r13)
  485.         oi     3(%r12),1                # set VM flag
  486. .Lnovm:
  487.         lh     %r0,__LC_CPUID+4         # get cpu version
  488.         chi    %r0,0x7490               # running on a P/390 ?
  489.         bne    .Lnop390-.LPG1(%r13)
  490.         oi     3(%r12),4                # set P/390 flag
  491. .Lnop390:
  492. #
  493. # find out if we have an IEEE fpu
  494. #
  495.         mvc    __LC_PGM_NEW_PSW(8),.Lpcfpu-.LPG1(%r13)
  496. efpc   %r0,0                    # test IEEE extract fpc instruction
  497.         oi     3(%r12),2                # set IEEE fpu flag
  498. .Lchkfpu:
  499. #
  500. # find out if we have the CSP instruction
  501. #
  502.        mvc    __LC_PGM_NEW_PSW(8),.Lpccsp-.LPG1(%r13)
  503.        la     %r0,0
  504.        lr     %r1,%r0
  505.        la     %r2,4
  506.        csp    %r0,%r2                   # Test CSP instruction
  507.        oi     3(%r12),8                 # set CSP flag
  508. .Lchkcsp:
  509. #
  510. # find out if we have the MVPG instruction
  511. #
  512.        mvc    __LC_PGM_NEW_PSW(8),.Lpcmvpg-.LPG1(%r13)
  513.        sr     %r0,%r0
  514.        la     %r1,0
  515.        la     %r2,0
  516.        mvpg   %r1,%r2                   # Test CSP instruction
  517.        oi     3(%r12),16                # set MVPG flag
  518. .Lchkmvpg:
  519.         lpsw  .Lentry-.LPG1(13)         # jump to _stext in primary-space,
  520.                                         # virtual and never return ...
  521.         .align 8
  522. .Lentry:.long  0x00080000,0x80000000 + _stext
  523. .Lctl:  .long  0x04b50002               # cr0: various things
  524.         .long  0                        # cr1: primary space segment table
  525.         .long  .Lduct                   # cr2: dispatchable unit control table
  526.         .long  0                        # cr3: instruction authorization
  527.         .long  0                        # cr4: instruction authorization
  528.         .long  0                        # cr5:  various things
  529.         .long  0                        # cr6:  I/O interrupts
  530.         .long  0                        # cr7:  secondary space segment table
  531.         .long  0                        # cr8:  access registers translation
  532.         .long  0                        # cr9:  tracing off
  533.         .long  0                        # cr10: tracing off
  534.         .long  0                        # cr11: tracing off
  535.         .long  0                        # cr12: tracing off
  536.         .long  0                        # cr13: home space segment table
  537.         .long  0xc0000000               # cr14: machine check handling off
  538.         .long  0                        # cr15: linkage stack operations
  539. .Lpcmem:.long  0x00080000,0x80000000 + .Lchkmem
  540. .Lpcfpu:.long  0x00080000,0x80000000 + .Lchkfpu
  541. .Lpccsp:.long  0x00080000,0x80000000 + .Lchkcsp
  542. .Lpcmvpg:.long 0x00080000,0x80000000 + .Lchkmvpg
  543. .Lmemsize:.long memory_size
  544. .Lmchunk:.long memory_chunk
  545. .Lmflags:.long machine_flags
  546. .org PARMAREA-64
  547. .Lduct: .long 0,0,0,0,0,0,0,0
  548. .long 0,0,0,0,0,0,0,0
  549. #
  550. # params at 10400 (setup.h)
  551. #
  552. .org   PARMAREA
  553. .global _pstart
  554. _pstart:
  555.         .long  0,0                      # IPL_DEVICE
  556.         .long  0,RAMDISK_ORIGIN         # INITRD_START
  557.         .long  0,RAMDISK_SIZE           # INITRD_SIZE
  558.         .org   COMMAND_LINE
  559.      .byte  "root=/dev/ram0 ro"
  560.         .byte  0
  561. .org   0x11000
  562. .global _pend
  563. _pend:
  564. #ifdef CONFIG_SHARED_KERNEL
  565. .org   0x100000
  566. #endif
  567. #
  568. # startup-code, running in virtual mode
  569. #
  570.         .globl _stext
  571. _stext: basr  %r13,0                    # get base
  572. .LPG2:
  573. #
  574. # Setup stack
  575. #
  576.         l     %r15,.Linittu-.LPG2(%r13)
  577.         ahi   %r15,8192                 # init_task_union + 8192
  578.         st    %r15,__LC_KERNEL_STACK    # set end of kernel stack
  579.         ahi   %r15,-96
  580.         xc    0(4,%r15),0(%r15)         # set backchain to zero
  581. #
  582. # clear bss memory
  583. #
  584.         l     %r2,.Lbss_bgn-.LPG2(%r13) # start of bss
  585.         l     %r3,.Lbss_end-.LPG2(%r13) # end of bss
  586.         sr    %r3,%r2                   # length of bss
  587.         sr    %r4,%r4                   #
  588.         sr    %r5,%r5                   # set src,length and pad to zero
  589.         sr    %r0,%r0                   #
  590.         mvcle %r2,%r4,0                 # clear mem
  591.         jo    .-4                       # branch back, if not finish
  592. # check control registers
  593.         stctl  %c0,%c15,0(%r15)
  594. oi     2(%r15),0x20             # enable sigp external interrupts
  595. oi     0(%r15),0x10             # switch on low address protection
  596.         lctl   %c0,%c15,0(%r15)
  597. #
  598.         lam    0,15,.Laregs-.LPG2(%r13) # load access regs needed by uaccess
  599.         l      %r14,.Lstart-.LPG2(%r13)
  600.         basr   %r14,%r14                # call start_kernel
  601. #
  602. # We returned from start_kernel ?!? PANIK
  603. #
  604.         basr  %r13,0
  605. lpsw  .Ldw-.(%r13)           # load disabled wait psw
  606. #
  607.             .align 8
  608. .Ldw:     .long  0x000a0000,0x00000000
  609. .Linittu:   .long  init_task_union
  610. .Lstart:    .long  start_kernel
  611. .Lbss_bgn:  .long  __bss_start
  612. .Lbss_end:  .long  _end
  613. .Laregs:    .long  0,0,0,0,1,0,0,0,0,0,0,0,0,0,0,0