source: trunk/kernel/devices/dev_iob.c @ 8

/*
 * dev_iob.c - IOB (bridge to external I/O) generic device API implementation.
 *
 * Authors   Alain Greiner  (2017)
 *
 * Copyright (c) UPMC Sorbonne Universites
 *
 * This file is part of ALMOS-MKH.
 *
 * ALMOS-MKH 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; version 2.0 of the License.
 *
 * ALMOS-MKH 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 PARTIOBLAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with ALMOS-MKH; if not, write to the Free Software Foundation,
 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
 */

#include <almos_config.h>
#include <hal_types.h>
#include <hal_special.h>
#include <remote_spinlock.h>
#include <chdev.h>
#include <printk.h>
#include <soclib_iob.h>
#include <dev_iob.h>

////////////////////////////////////
void dev_iob_init( chdev_t * chdev )
{
    // get implementation 
    uint32_t  impl = chdev->impl;

    // call driver init function
    if( impl == IMPL_IOB_TSR )
    {
        soclib_iob_init( chdev );
    }
    else
    {
        assert( false , __FUNCTION__ , "undefined IOB device implementation\n" );
    }
}

//////////////////////////////////////////
void dev_iob_iommu_enable( xptr_t dev_xp )
{
    // get IOB chdev descriptor cluster and local pointer
    cxy_t     dev_cxy = GET_CXY( dev_xp );
    chdev_t * dev_ptr = (chdev_t *)GET_PTR( dev_xp );

    // get implementation from chdev descriptor
    uint32_t  impl = hal_remote_lw( XPTR( dev_cxy , &dev_ptr->impl ) );

    // call driver function
    if( impl == IMPL_IOB_TSR )
    {
        remote_spinlock_lock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
        soclib_iob_set_active( dev_xp , 1 );
        remote_spinlock_unlock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
    }
    else
    {
        printk("\n[PANIC] in %s: undefined IOB device implementation\n", __FUNCTION__ );
        hal_core_sleep();
    }
}

///////////////////////////////////////////
void dev_iob_iommu_disable( xptr_t dev_xp )
{
    // get IOB chdev descriptor cluster and local pointer
    cxy_t     dev_cxy = GET_CXY( dev_xp );
    chdev_t * dev_ptr = (chdev_t *)GET_PTR( dev_xp );

    // get implementation from chdev descriptor
    uint32_t  impl = hal_remote_lw( XPTR( dev_cxy , &dev_ptr->impl ) );

    // call driver function
    if( impl == IMPL_IOB_TSR )
    {
        remote_spinlock_lock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
        soclib_iob_set_active( dev_xp , 0 );
        remote_spinlock_unlock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
    }
    else
    {
        printk("\n[PANIC] in %s: undefined IOB device implementation\n", __FUNCTION__ );
        hal_core_sleep();
    }
}

////////////////////////////////////////
void dev_iob_set_ptpr( xptr_t    dev_xp,
                       uint32_t  wdata )
{
    // get IOB chdev descriptor cluster and local pointer
    cxy_t     dev_cxy = GET_CXY( dev_xp );
    chdev_t * dev_ptr = (chdev_t *)GET_PTR( dev_xp );

    // get implementation from chdev descriptor
    uint32_t  impl = hal_remote_lw( XPTR( dev_cxy , &dev_ptr->impl ) );

    // call driver function
    if( impl == IMPL_IOB_TSR )
    {
        remote_spinlock_lock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
        soclib_iob_set_ptpr( dev_xp , wdata );
        remote_spinlock_unlock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
    }
    else
    {
        printk("\n[PANIC] in %s: undefined IOB device implementation\n", __FUNCTION__ );
        hal_core_sleep();
    }
}
                        
////////////////////////////////////////
void dev_iob_inval_page( xptr_t  dev_xp,
                         vpn_t   vpn )
{
    // get IOB chdev descriptor cluster and local pointer
    cxy_t     dev_cxy = GET_CXY( dev_xp );
    chdev_t * dev_ptr = (chdev_t *)GET_PTR( dev_xp );

    // get implementation from chdev descriptor
    uint32_t  impl = hal_remote_lw( XPTR( dev_cxy , &dev_ptr->impl ) );

    // call driver function
    if( impl == IMPL_IOB_TSR )
    {
        remote_spinlock_lock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
        soclib_iob_inval_page( dev_xp , vpn );
        remote_spinlock_unlock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
    }
    else
    {
        printk("\n[PANIC] in %s: undefined IOB device implementation\n", __FUNCTION__ );
        hal_core_sleep();
    }
}

///////////////////////////////////////////
void dev_iob_get_status( xptr_t     dev_xp,
                         uint32_t * error,
                         uint32_t * bvar,
                         uint32_t * srcid )
{
    // get IOB chdev descriptor cluster and local pointer
    cxy_t     dev_cxy = GET_CXY( dev_xp );
    chdev_t * dev_ptr = (chdev_t *)GET_PTR( dev_xp );

    // get implementation from chdev descriptor
    uint32_t  impl = hal_remote_lw( XPTR( dev_cxy , &dev_ptr->impl ) );

    // call driver function
    if( impl == IMPL_IOB_TSR )
    {
        remote_spinlock_lock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
        *error = soclib_iob_get_error( dev_xp );
        *srcid = soclib_iob_get_srcid( dev_xp );
        *bvar  = soclib_iob_get_bvar( dev_xp );
        remote_spinlock_unlock( XPTR( dev_cxy , &dev_ptr->wait_lock ) );
    }
    else
    {
        printk("\n[PANIC] in %s: undefined IOB device implementation\n", __FUNCTION__ );
        hal_core_sleep();
    }
}