/*! * Create global message queue */ int sys__create_msg_queue ( void *p ) { /* parameters on thread stack */ msg_q *msgq; uint min_prio; /* local variables */ kgmsg_q *gmsgq; msgq = *( (msg_q **) p ); p += sizeof (msg_q *); min_prio = *( (uint *) p ); ASSERT_ERRNO_AND_EXIT ( msgq, E_INVALID_HANDLE ); msgq = U2K_GET_ADR ( msgq, k_get_active_process () ); gmsgq = kmalloc ( sizeof ( kgmsg_q ) ); ASSERT_ERRNO_AND_EXIT ( gmsgq, E_NO_MEMORY ); list_init ( &gmsgq->mq.msgs ); /* list for messages */ k_threadq_init ( &gmsgq->mq.thrq ); /* list for blocked threads */ gmsgq->mq.min_prio = min_prio; msgq->id = gmsgq->id = k_new_unique_id (); msgq->handle = gmsgq; list_append ( &kmsg_qs, gmsgq, &gmsgq->all ); /* all msg.q. list */ EXIT ( SUCCESS ); }
/*! * Create new thread * \param start_func Starting function for new thread * \param param Parameter sent to starting function * \param exit_func Thread will call this function when it leaves 'start_func' * \param prio Thread priority * \param stack Address of thread stack (if not NULL) * \param stack_size Stack size * \param run Move thread descriptor to ready threads? * \param proc Process descriptor thread belongs to * \return Pointer to descriptor of created kernel thread */ kthread_t *k_create_thread ( void *start_func, void *param, void *exit_func, int prio, void *stack, size_t stack_size, int run, kprocess_t *proc ) { kthread_t *kthr; /* if stack is not defined */ if ( proc && proc->stack_pool && ( !stack || !stack_size ) ) { stack_size = proc->pi->thread_stack; stack = ffs_alloc ( proc->stack_pool, stack_size ); } else if ( !stack || !stack_size ) { if ( !stack_size ) stack_size = DEFAULT_THREAD_STACK_SIZE; stack = kmalloc ( stack_size ); } ASSERT ( stack && stack_size ); kthr = kmalloc ( sizeof (kthread_t) ); /* thread descriptor */ ASSERT ( kthr ); /* initialize thread descriptor */ kthr->id = k_new_unique_id (); kthr->state = THR_STATE_PASSIVE; if ( prio < 0 ) prio = 0; if ( prio >= PRIO_LEVELS ) prio = PRIO_LEVELS - 1; kthr->sched.prio = prio; arch_create_thread_context ( &kthr->context, start_func, param, exit_func, stack, stack_size, proc ); kthr->queue = NULL; kthr->exit_status = 0; k_threadq_init ( &kthr->join_queue ); kthr->ref_cnt = 0; if ( run ) { move_to_ready ( kthr ); kthr->ref_cnt = 1; } kthr->stack = stack; kthr->stack_size = stack_size; kthr->proc = proc; kthr->proc->thr_count++; kthr->private_storage = NULL; #ifdef MESSAGES k_thr_msg_init ( &kthr->msg ); #endif list_append ( &all_threads, kthr, &kthr->all ); return kthr; }
/*! * Create global message queue */ int sys__create_msg_queue ( msg_q *msgq, uint min_prio ) { kgmsg_q *gmsgq; ASSERT_ERRNO_AND_EXIT ( msgq, E_INVALID_HANDLE ); gmsgq = kmalloc ( sizeof ( kgmsg_q ) ); ASSERT_ERRNO_AND_EXIT ( gmsgq, E_NO_MEMORY ); list_init ( &gmsgq->mq.msgs ); /* list for messages */ k_threadq_init ( &gmsgq->mq.thrq ); /* list for blocked threads */ gmsgq->mq.min_prio = min_prio; msgq->id = gmsgq->id = k_new_unique_id (); msgq->handle = gmsgq; list_append ( &kmsg_qs, gmsgq, &gmsgq->all ); /* all msg.q. list */ EXIT ( SUCCESS ); }