summary refs log tree commit diff
path: root/sysdeps/mach/hurd/mips/init-first.c
blob: 72c7a61cb07e0c5d92b6837275914f3df8d67e8a (plain) (blame)
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
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
/* Initialization code run first thing by the ELF startup code.  For Mips/Hurd.
   Copyright (C) 1996, 1997, 1998, 2000 Free Software Foundation, Inc.
   This file is part of the GNU C Library.

   The GNU C Library is free software; you can redistribute it and/or
   modify it under the terms of the GNU Library General Public License as
   published by the Free Software Foundation; either version 2 of the
   License, or (at your option) any later version.

   The GNU C Library is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
   Library General Public License for more details.

   You should have received a copy of the GNU Library General Public
   License along with the GNU C Library; see the file COPYING.LIB.  If not,
   write to the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
   Boston, MA 02111-1307, USA.  */

#include <hurd.h>
#include <stdio.h>
#include <unistd.h>
#include <string.h>
#include "hurdstartup.h"
#include "set-hooks.h"
#include "hurdmalloc.h"		/* XXX */

extern void __mach_init (void);
extern void __libc_init (int, char **, char **);
extern void __getopt_clean_environment (char **);
extern void __libc_global_ctors (void);

unsigned int __hurd_threadvar_max;
unsigned long int __hurd_threadvar_stack_offset;
unsigned long int __hurd_threadvar_stack_mask;

int __libc_multiple_libcs = 1;

int __libc_argc;
char **__libc_argv;

void *(*_cthread_init_routine) (void); /* Returns new SP to use.  */
void (*_cthread_exit_routine) (int status) __attribute__ ((__noreturn__));


/* Things that want to be run before _hurd_init or much anything else.
   Importantly, these are called before anything tries to use malloc.  */
DEFINE_HOOK (_hurd_preinit_hook, (void));

static void
init1 (int argc, char *arg0, ...)
{
  char **argv = &arg0;
  char **envp = &argv[argc + 1];
  struct hurd_startup_data *d;

  __libc_argc = argc;
  __libc_argv = argv;
  __environ = envp;
  while (*envp)
    ++envp;
  d = (void *) ++envp;

  /* If we are the bootstrap task started by the kernel,
     then after the environment pointers there is no Hurd
     data block; the argument strings start there.  */
  if ((void *) d != argv[0])
    {
      _hurd_init_dtable = d->dtable;
      _hurd_init_dtablesize = d->dtablesize;

      {
	/* Check if the stack we are now on is different from
	   the one described by _hurd_stack_{base,size}.  */

	char dummy;
	const vm_address_t newsp = (vm_address_t) &dummy;

	if (d->stack_size != 0 && (newsp < d->stack_base ||
				   newsp - d->stack_base > d->stack_size))
	  /* The new stack pointer does not intersect with the
	     stack the exec server set up for us, so free that stack.  */
	  __vm_deallocate (__mach_task_self (), d->stack_base, d->stack_size);
      }
    }

  if (__hurd_threadvar_stack_mask == 0)
    {
      /* We are not using cthreads, so we will have just a single allocated
	 area for the per-thread variables of the main user thread.  */
      unsigned long int i;
      __hurd_threadvar_stack_offset
	= (unsigned long int) malloc (__hurd_threadvar_max *
				      sizeof (unsigned long int));
      if (__hurd_threadvar_stack_offset == 0)
	__libc_fatal ("Can't allocate single-threaded per-thread variables.");
      for (i = 0; i < __hurd_threadvar_max; ++i)
	((unsigned long int *) __hurd_threadvar_stack_offset)[i] = 0;
    }

  if ((void *) d != argv[0] && (d->portarray || d->intarray))
    /* Initialize library data structures, start signal processing, etc.  */
    _hurd_init (d->flags, argv,
		d->portarray, d->portarraysize,
		d->intarray, d->intarraysize);

  __libc_init (argc, argv, __environ);

  /* This is a hack to make the special getopt in GNU libc working.  */
  __getopt_clean_environment (envp);

#ifdef SHARED
  __libc_global_ctors ();
#endif

  (void) &init1;
}

static void *
__init (int *data)
{
  int argc = *data;
  char **argv = (void *) (data + 1);
  char **envp = &argv[argc + 1];
  struct hurd_startup_data *d;

  __environ = envp;
  while (*envp)
    ++envp;
  d = (void *) ++envp;

  /* The user might have defined a value for this, to get more variables.
     Otherwise it will be zero on startup.  We must make sure it is set
     properly before before cthreads initialization, so cthreads can know
     how much space to leave for thread variables.  */
  if (__hurd_threadvar_max < _HURD_THREADVAR_MAX)
    __hurd_threadvar_max = _HURD_THREADVAR_MAX;


  /* After possibly switching stacks, call `init1' (above) with the user
     code as the return address, and the argument data immediately above
     that on the stack.  */

  if (_cthread_init_routine)
    {
      /* Initialize cthreads, which will allocate us a new stack to run on.  */
      void *newsp = (*_cthread_init_routine) ();
      struct hurd_startup_data *od;

      /* Copy the argdata from the old stack to the new one.  */
      newsp = memcpy (newsp - ((char *) &d[1] - (char *) data), data,
		      (char *) d - (char *) data);

      /* Set up the Hurd startup data block immediately following
	 the argument and environment pointers on the new stack.  */
      od = (newsp + ((char *) d - (char *) data));
      if ((void *) argv[0] == d)
	/* We were started up by the kernel with arguments on the stack.
	   There is no Hurd startup data, so zero the block.  */
	memset (od, 0, sizeof *od);
      else
	/* Copy the Hurd startup data block to the new stack.  */
	*od = *d;

      /* Push the user code address on the top of the new stack.  It will
	 be the return address for `init1'; we will jump there with NEWSP
	 as the stack pointer.  */
      return newsp;
    }

  /* The argument data is just above the stack frame we will unwind by
     returning.  */
  return (void *) data;

  (void) &__init;
}

#ifdef SHARED
/* This function is called to initialize the shared C library.
   It is called just before the user _start code from mips/elf/start.S,
   with the stack set up as that code gets it.  */

/* NOTE!  The linker notices the magical name `_init' and sets the DT_INIT
   pointer in the dynamic section based solely on that.  It is convention
   for this function to be in the `.init' section, but the symbol name is
   the only thing that really matters!!  */
/*void _init (int argc, ...) __attribute__ ((unused, section (".init")));*/

#if __mips64
asm ("\
	.section .init,\"ax\",@progbits\n\
	.align 3\n\
	.globl _init\n\
	.type _init,@function\n\
	.ent _init\n\
_init:\n\
	.set noreorder\n\
	.cpload $25\n\
	.set reorder\n\
	dsubu $29, 8*8\n\
	.cprestore 6*8\n\
	sd $16, 4*8($29)\n\
	sd $31, 5*8($29)\n\
	jal preinit\n\
	sd $28, 6*8($29)\n\
	move $16, $29 # Save the old stack pointer to s0 ($16)\n\
	daddu $4, $29, 4*8
	jal __init\n\
	# Restore saved registers from the old stack.\n\
	ld $28, 6*8($16)\n\
	ld $31, 5*8($16)\n\
	ld $16, 4*8($16)\n\
	move $29, $2 # set new sp to SP\n\
call_init1:\n\
	ld $4, 0($29)\n\
	ld $5, 1*8($29)\n\
	ld $6, 2*8($29)\n\
	ld $7, 3*8($29)\n\
	dla $25, init1\n\
	jr $25\n\
	.end _init\n\
	.text\n\
");
#else
asm ("\
	.section .init,\"ax\",@progbits\n\
	.align 2\n\
	.globl _init\n\
	.type _init,@function\n\
	.ent _init\n\
_init:\n\
	.set noreorder\n\
	.cpload $25\n\
	.set reorder\n\
	subu $29, 32\n\
	.cprestore 24\n\
	sw $16, 16($29)\n\
	sw $31, 20($29)\n\
	jal preinit\n\
	sw $28, 24($29)\n\
	move $16, $29 # Save the old stack pointer to s0 ($16)\n\
	addu $4, $29, 32
	jal __init\n\
	# Restore saved registers from the old stack.\n\
	lw $28, 24($16)\n\
	lw $31, 20($16)\n\
	lw $16, 16($16)\n\
	move $29, $2 # set new sp to SP\n\
call_init1:\n\
	lw $4, 0($29)\n\
	lw $5, 4($29)\n\
	lw $6, 8($29)\n\
	lw $7, 12($29)\n\
	la $25, init1\n\
	jr $25\n\
	.end _init\n\
	.text\n\
");
#endif

static void
preinit (void)
{
  /* Initialize data structures so we can do RPCs.  */
  __mach_init ();

  RUN_HOOK (_hurd_preinit_hook, ());

  (void) &preinit;
}

void __libc_init_first (int argc, ...)
{
}
#endif

#ifndef SHARED
/* An assembler code wrapping c function __init.  */
#ifdef __mips64
asm ("\
	.text\n\
	.align 3\n\
init:\n\
	dsubu $29, 8*8\n\
	sd $16, 4*8($29)\n\
	sd $31, 5*8($29)\n\
	move $16, $29\n\
	jal __init\n\
	ld $31, 5*8($16)\n\
	ld $16, 4*8($16)\n\
	move $29, $2 # set new sp to SP\n\
call_init1:\n\
	ld $4, 0($29)\n\
	ld $5, 1*8($29)\n\
	ld $6, 2*8($29)\n\
	ld $7, 3*8($29)\n\
	dla $25, init1\n\
	jr $25\n\
");
#else
asm ("\
	.text\n\
	.align 2\n\
init:\n\
	subu $29, 32\n\
	sw $16, 16($29)\n\
	sw $31, 20($29)\n\
	move $16, $29\n\
	jal __init\n\
	lw $31, 20($16)\n\
	lw $16, 16($16)\n\
	move $29, $2 # set new sp to SP\n\
call_init1:\n\
	lw $4, 0($29)\n\
	lw $5, 4($29)\n\
	lw $6, 8($29)\n\
	lw $7, 12($29)\n\
	la $25, init1\n\
	jr $25\n\
");
#endif

/* An assembler code wrapping c function ___libc_init_first.
   ___libc_init_first does an RPC call to flush cache to put doinit
   function on the stack, so we should call __mach_init first in
   this wrap. */
#ifdef __mips64
asm ("\
	.text\n\
	.align 3\n\
	.globl __libc_init_first\n\
__libc_init_first:\n\
	dsubu $29, 8\n\
	sd $31, 0($29)
	jal __mach_init\n\
	ld $4, 0($29)
	ld $5, 1*8($29)
	ld $6, 2*8($29)
	ld $7, 3*8($29)
	j ___libc_init_first\n\
");
#else
asm ("\
	.text\n\
	.align 2\n\
	.globl __libc_init_first\n\
__libc_init_first:\n\
	subu $29, 4\n\
	sw $31, 0($29)
	jal __mach_init\n\
	lw $4, 0($29)
	lw $5, 4($29)
	lw $6, 8($29)
	lw $7, 12($29)
	j ___libc_init_first\n\
");
#endif

static void
___libc_init_first (int return_addr, int argc, ...)
{
  void doinit (int *data)
    {
#if 0
      /* This function gets called with the argument data at TOS.  */
      void doinit1 (int argc, ...)
	{
	  init (&argc);
	}
#endif
      extern void init (int *data);

      /* Push the user return address after the argument data, and then
	 jump to `doinit1' (above), so it is as if __libc_init_first's
	 caller had called `init' with the argument data already on the
	 stack.  */
      *--data = return_addr;

#ifdef __mips64
      asm volatile ("ld $31, 0(%0)\n" /* Load the original return address.  */
		    "daddu $29, %0, 8\n" /* Switch to new outermost stack.  */
		    "move $4, $29\n"
		    "jr %1" : : "r" (data), "r" (&init));
#else
      asm volatile ("lw $31, 0(%0)\n" /* Load the original return address.  */
		    "addu $29, %0, 4\n" /* Switch to new outermost stack.  */
		    "move $4, $29\n"
		    "jr %1" : : "r" (data), "r" (&init));
#endif
      /* NOTREACHED */
    }

#if 0
  /* Initialize data structures so we can do RPCs.  */
  __mach_init ();
#endif

  RUN_HOOK (_hurd_preinit_hook, ());

  _hurd_startup ((void **) &argc, &doinit);

  (void) &___libc_init_first;
}
#endif