Subversion Repositories openrisc_me

//==========================================================================
//
//      pthread.cxx
//
//      POSIX pthreads implementation
//
//==========================================================================
//####ECOSGPLCOPYRIGHTBEGIN####
// -------------------------------------------
// This file is part of eCos, the Embedded Configurable Operating System.
// Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
//
// eCos is free software; you can redistribute it and/or modify it under
// the terms of the GNU General Public License as published by the Free
// Software Foundation; either version 2 or (at your option) any later version.
//
// eCos 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 General Public License
// for more details.
//
// You should have received a copy of the GNU General Public License along
// with eCos; if not, write to the Free Software Foundation, Inc.,
// 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
//
// As a special exception, if other files instantiate templates or use macros
// or inline functions from this file, or you compile this file and link it
// with other works to produce a work based on this file, this file does not
// by itself cause the resulting work to be covered by the GNU General Public
// License. However the source code for this file must still be made available
// in accordance with section (3) of the GNU General Public License.
//
// This exception does not invalidate any other reasons why a work based on
// this file might be covered by the GNU General Public License.
//
// Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
// at http://sources.redhat.com/ecos/ecos-license/
// -------------------------------------------
//####ECOSGPLCOPYRIGHTEND####
//==========================================================================
//#####DESCRIPTIONBEGIN####
//
// Author(s):           nickg
// Contributors:        nickg, jlarmour, Wade Jensen
// Date:                2000-03-27
// Purpose:             POSIX pthread implementation
// Description:         This file contains the implementation of the POSIX pthread
//                      functions.
//              
//              
//
//####DESCRIPTIONEND####
//
//==========================================================================
 
#include <pkgconf/posix.h>
 
#include <cyg/infra/cyg_trac.h>        // tracing macros
#include <cyg/infra/cyg_ass.h>         // assertion macros
 
#include "pprivate.h"                  // POSIX private header
 
#include <cyg/kernel/thread.hxx>       // thread definitions
#include <cyg/kernel/mutex.hxx>        // mutex definitions
#include <cyg/kernel/clock.hxx>        // clock definitions
#include <cyg/kernel/sched.hxx>        // scheduler primitives
#include <pthread.h>
 
#include <cyg/kernel/thread.inl>       // thread inlines
#include <cyg/kernel/sched.inl>        // scheduler inlines
 
//-----------------------------------------------------------------------------
// new operator to allow us to construct mutex objects
 
inline void *operator new(size_t size,  cyg_uint8 *ptr) { return (void *)ptr; };
 
//=============================================================================
// Mutexes
 
//-----------------------------------------------------------------------------
// Mutex attributes manipulation functions
 
//-----------------------------------------------------------------------------
// Initialize attribute object
 
externC int pthread_mutexattr_init ( pthread_mutexattr_t *attr)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    attr->protocol      = PTHREAD_PRIO_NONE;
#ifdef _POSIX_THREAD_PRIO_PROTECT    
    attr->prioceiling   = 0;
#endif
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Destroy attribute object
 
externC int pthread_mutexattr_destroy ( pthread_mutexattr_t *attr)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    // Nothing to do here...
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Optional functions depending on priority inversion protection options.
 
#if defined(_POSIX_THREAD_PRIO_INHERIT) || defined(_POSIX_THREAD_PRIO_PROTECT)
 
// Set priority inversion protection protocol
externC int pthread_mutexattr_setprotocol ( pthread_mutexattr_t *attr,
                                            int protocol)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    switch( protocol )
    {
    case PTHREAD_PRIO_NONE:
#if defined(_POSIX_THREAD_PRIO_INHERIT)        
    case PTHREAD_PRIO_INHERIT:
#endif
#if defined(_POSIX_THREAD_PRIO_PROTECT)
    case PTHREAD_PRIO_PROTECT:
#endif        
        attr->protocol = protocol;
        PTHREAD_RETURN(0);
 
    default:
        PTHREAD_RETURN(EINVAL);
    }
 
    PTHREAD_RETURN(0);
}
 
// Get priority inversion protection protocol
externC int pthread_mutexattr_getprotocol ( pthread_mutexattr_t *attr,
                                            int *protocol)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    if( protocol != NULL )
        *protocol = attr->protocol;
 
    PTHREAD_RETURN(0);
}
 
#if defined(_POSIX_THREAD_PRIO_PROTECT)
 
// Set priority for priority ceiling protocol
externC int pthread_mutexattr_setprioceiling ( pthread_mutexattr_t *attr,
                                               int prioceiling)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
 
    attr->prioceiling = prioceiling;
 
    PTHREAD_RETURN(0);
}
 
// Get priority for priority ceiling protocol
externC int pthread_mutexattr_getprioceiling ( pthread_mutexattr_t *attr,
                                               int *prioceiling)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    if( prioceiling != NULL )
        *prioceiling = attr->prioceiling;
 
    PTHREAD_RETURN(0);
}
 
// Set priority ceiling of given mutex, returning old ceiling.
externC int pthread_mutex_setprioceiling( pthread_mutex_t *mutex,
                                          int prioceiling,
                                          int *old_ceiling)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(mutex);
 
    pthread_mutex_lock( mutex );
 
    Cyg_Mutex *mx = (Cyg_Mutex *)mutex;
 
    if( old_ceiling != NULL )
        *old_ceiling = mx->get_ceiling();
 
    mx->set_ceiling( prioceiling );
 
    pthread_mutex_unlock( mutex );
 
    PTHREAD_RETURN(0);
}
 
// Get priority ceiling of given mutex
externC int pthread_mutex_getprioceiling( pthread_mutex_t *mutex,
                                          int *prioceiling)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(mutex);
 
    Cyg_Mutex *mx = (Cyg_Mutex *)mutex;
 
    if( prioceiling != NULL )
        *prioceiling = mx->get_ceiling();
 
    PTHREAD_RETURN(0);
}
 
#endif // defined(_POSIX_THREAD_PRIO_PROTECT)
 
#endif // defined(_POSIX_THREAD_PRIO_INHERIT) || defined(_POSIX_THREAD_PRIO_PROTECT)
 
//-----------------------------------------------------------------------------
// Mutex functions
 
//-----------------------------------------------------------------------------
// Initialize mutex. If mutex_attr is NULL, use default attributes.
 
externC int pthread_mutex_init (pthread_mutex_t *mutex,
                                const pthread_mutexattr_t *mutex_attr)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( mutex );
 
    pthread_mutexattr_t use_attr;
 
    // Set up the attributes we are going to use
    if( mutex_attr == NULL )
        pthread_mutexattr_init( &use_attr );
    else use_attr = *mutex_attr;
 
    // Now translate the POSIX protocol identifier into the eCos one.
    Cyg_Mutex::cyg_protcol protocol;
 
    switch( use_attr.protocol )
    {
#if defined(_POSIX_THREAD_PRIO_PROTECT)
    case PTHREAD_PRIO_PROTECT:
        protocol = Cyg_Mutex::CEILING;
        break;
#endif
#if defined(_POSIX_THREAD_PRIO_INHERIT)
    case PTHREAD_PRIO_INHERIT:
        protocol = Cyg_Mutex::INHERIT;
        break;
#endif        
    case PTHREAD_PRIO_NONE:
        protocol = Cyg_Mutex::NONE;
        break;
 
    default:
        PTHREAD_RETURN(EINVAL);
    }
 
    Cyg_Mutex *mx = new((cyg_uint8 *)mutex) Cyg_Mutex(  protocol );
 
    mx = mx; // silence compiler warning
#if defined(_POSIX_THREAD_PRIO_PROTECT)
    if ( protocol == Cyg_Mutex::CEILING )
        mx->set_ceiling( use_attr.prioceiling );
#endif
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Destroy mutex.
 
externC int pthread_mutex_destroy (pthread_mutex_t *mutex)
{
    PTHREAD_ENTRY();
 
    int err = ENOERR;
 
    PTHREAD_CHECK( mutex );
 
    Cyg_Mutex *mx = (Cyg_Mutex *)mutex;
 
    if( mx->get_owner() != NULL )
        err = EBUSY;
    else mx->~Cyg_Mutex();
 
    PTHREAD_RETURN(err);
}
 
//-----------------------------------------------------------------------------
// Lock mutex, waiting for it if necessary.
 
externC int pthread_mutex_lock (pthread_mutex_t *mutex)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( mutex );
 
    Cyg_Mutex *mx = (Cyg_Mutex *)mutex;
 
    if( mx->get_owner() == Cyg_Thread::self() )
        PTHREAD_RETURN(EDEADLK);
 
    // Loop here until we acquire the mutex. Even if we are kicked out
    // of the wait by a signal or release we must retry.
    while( !mx->lock() )
        continue;
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Try to lock mutex.
 
externC int pthread_mutex_trylock (pthread_mutex_t *mutex)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( mutex );
 
    Cyg_Mutex *mx = (Cyg_Mutex *)mutex;
 
    if( mx->get_owner() == Cyg_Thread::self() )
        PTHREAD_RETURN(EDEADLK);
 
    if( mx->trylock() )
        PTHREAD_RETURN(0);
 
    PTHREAD_RETURN(EBUSY);
}
 
 
//-----------------------------------------------------------------------------
// Unlock mutex.
 
externC int pthread_mutex_unlock (pthread_mutex_t *mutex)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( mutex );
 
    Cyg_Mutex *mx = (Cyg_Mutex *)mutex;
 
    mx->unlock();
 
    PTHREAD_RETURN(0);
}
 
 
//=============================================================================
// Condition Variables
 
//-----------------------------------------------------------------------------
// Attribute manipulation functions
// We do not actually support any attributes at present, so these do nothing.
 
//-----------------------------------------------------------------------------
// Initialize condition variable attributes
 
externC int pthread_condattr_init (pthread_condattr_t *attr)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    // There are no condition variable attributes at present
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Destroy condition variable attributes
 
externC int pthread_condattr_destroy (pthread_condattr_t *attr)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK(attr);
 
    // nothing to do here...
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Condition variable functions
 
//-----------------------------------------------------------------------------
// Initialize condition variable.
 
externC int pthread_cond_init (pthread_cond_t *cond,
                               const pthread_condattr_t *attr)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( cond );
 
    Cyg_Condition_Variable *cv =
        new((cyg_uint8 *)cond) Cyg_Condition_Variable();
 
    cv = cv;
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Destroy condition variable.
 
externC int pthread_cond_destroy (pthread_cond_t *cond)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( cond );
 
    ((Cyg_Condition_Variable *)cond)->~Cyg_Condition_Variable();
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Wake up one thread waiting for condition variable
 
externC int pthread_cond_signal (pthread_cond_t *cond)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( cond );
 
    ((Cyg_Condition_Variable *)cond)->signal();
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Wake up all threads waiting for condition variable
 
externC int pthread_cond_broadcast (pthread_cond_t *cond)
{
    PTHREAD_ENTRY();
 
    PTHREAD_CHECK( cond );
 
    ((Cyg_Condition_Variable *)cond)->broadcast();
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Block on condition variable until signalled. The mutex is
// assumed to be locked before this call, will be unlocked
// during the wait, and will be re-locked on wakeup.
 
externC int pthread_cond_wait (pthread_cond_t *cond,
                               pthread_mutex_t *mutex)
{
    PTHREAD_ENTRY();
 
    // check for cancellation first.
    PTHREAD_TESTCANCEL();
 
    PTHREAD_CHECK( cond );
    PTHREAD_CHECK( mutex );    
 
    ((Cyg_Condition_Variable *)cond)->wait( *(Cyg_Mutex *)mutex );
 
    // check if we were woken because we were being cancelled
    PTHREAD_TESTCANCEL();
 
    PTHREAD_RETURN(0);
}
 
//-----------------------------------------------------------------------------
// Block on condition variable until signalled, or the timeout expires.
 
externC int pthread_cond_timedwait (pthread_cond_t *cond,
                                    pthread_mutex_t *mutex,
                                    const struct timespec *abstime)
{
    PTHREAD_ENTRY();
 
    // check for cancellation first.
    PTHREAD_TESTCANCEL();
 
    PTHREAD_CHECK( cond );
    PTHREAD_CHECK( mutex );    
    PTHREAD_CHECK( abstime );    
 
    // Only initialize the converters once or they will consume a huge
    // amount or runtime.
 
    static struct Cyg_Clock::converter ns_converter;
    static struct Cyg_Clock::converter sec_converter;
    static volatile cyg_atomic conv_init;
    if (!conv_init)
    {
 
        // Try to avoid unnecessarily locking the scheduler when we are not
        // initializing the converters.  Check the conv_init flag again to
        // avoid race conditions.
 
        struct Cyg_Clock::converter temp_ns_converter, temp_sec_converter;
 
        Cyg_Clock::real_time_clock
            ->get_other_to_clock_converter( 1, &temp_ns_converter );
        Cyg_Clock::real_time_clock
            ->get_other_to_clock_converter( 1000000000, &temp_sec_converter );
 
        Cyg_Scheduler::lock();
        if (!conv_init)
        {
            ns_converter = temp_ns_converter;
            sec_converter = temp_sec_converter;
            conv_init=1;
        }
        Cyg_Scheduler::unlock();
    }
 
    cyg_tick_count ticks;
    ticks = Cyg_Clock::convert( abstime->tv_sec, &sec_converter );
    ticks += Cyg_Clock::convert( abstime->tv_nsec, &ns_converter );
 
    ((Cyg_Condition_Variable *)cond)->wait( *(Cyg_Mutex *)mutex, ticks );
 
    // check if we were woken because we were being cancelled
    PTHREAD_TESTCANCEL();
 
    if ( Cyg_Thread::self()->get_wake_reason() == Cyg_Thread::TIMEOUT )
        PTHREAD_RETURN(ETIMEDOUT);
    else
        PTHREAD_RETURN(0);
}
 
// -------------------------------------------------------------------------
// EOF mutex.cxx