kernel_thread.S 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778
  1. /* kernel_thread.S: kernel thread creation
  2. *
  3. * Copyright (C) 2003 Red Hat, Inc. All Rights Reserved.
  4. * Written by David Howells (dhowells@redhat.com)
  5. *
  6. * This program is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU General Public License
  8. * as published by the Free Software Foundation; either version
  9. * 2 of the License, or (at your option) any later version.
  10. */
  11. #include <linux/linkage.h>
  12. #include <asm/unistd.h>
  13. #define CLONE_VM 0x00000100 /* set if VM shared between processes */
  14. #define KERN_ERR "<3>"
  15. .section .rodata
  16. kernel_thread_emsg:
  17. .asciz KERN_ERR "failed to create kernel thread: error=%d\n"
  18. .text
  19. .balign 4
  20. ###############################################################################
  21. #
  22. # Create a kernel thread
  23. #
  24. # int kernel_thread(int (*fn)(void *), void * arg, unsigned long flags)
  25. #
  26. ###############################################################################
  27. .globl kernel_thread
  28. .type kernel_thread,@function
  29. kernel_thread:
  30. or.p gr8,gr0,gr4
  31. or gr9,gr0,gr5
  32. # start by forking the current process, but with shared VM
  33. setlos.p #__NR_clone,gr7 ; syscall number
  34. ori gr10,#CLONE_VM,gr8 ; first syscall arg [clone_flags]
  35. sethi.p #0xe4e4,gr9 ; second syscall arg [newsp]
  36. setlo #0xe4e4,gr9
  37. setlos.p #0,gr10 ; third syscall arg [parent_tidptr]
  38. setlos #0,gr11 ; fourth syscall arg [child_tidptr]
  39. tira gr0,#0
  40. setlos.p #4095,gr7
  41. andcc gr8,gr8,gr0,icc0
  42. addcc.p gr8,gr7,gr0,icc1
  43. bnelr icc0,#2
  44. bc icc1,#0,kernel_thread_error
  45. # now invoke the work function
  46. or gr5,gr0,gr8
  47. calll @(gr4,gr0)
  48. # and finally exit the thread
  49. setlos #__NR_exit,gr7 ; syscall number
  50. tira gr0,#0
  51. kernel_thread_error:
  52. subi sp,#8,sp
  53. movsg lr,gr4
  54. sti gr8,@(sp,#0)
  55. sti.p gr4,@(sp,#4)
  56. or gr8,gr0,gr9
  57. sethi.p %hi(kernel_thread_emsg),gr8
  58. setlo %lo(kernel_thread_emsg),gr8
  59. call printk
  60. ldi @(sp,#4),gr4
  61. ldi @(sp,#0),gr8
  62. subi sp,#8,sp
  63. jmpl @(gr4,gr0)
  64. .size kernel_thread,.-kernel_thread