source: trunk/hal/tsar_mips32/drivers/soclib_mmc.c @ 452

Last change on this file since 452 was 451, checked in by alain, 6 years ago

Fix a bug in soclib_pic driver (bad separation between IOPIC an LAPIC initialisation)

File size: 5.2 KB
Line 
1/*
2 * soclib_mmc.c - soclib L2 cache controller driver implementation.
3 *
4 * Author     Alain Greiner (2016)
5 *
6 * Copyright (c) UPMC Sorbonne Universites
7 *
8 * This file is part of ALMOS-MKH..
9 *
10 * ALMOS-MKH. is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; version 2.0 of the License.
13 *
14 * ALMOS-MKH. is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with ALMOS-MKH.; if not, write to the Free Software Foundation,
21 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
22 */
23
24
25#include <hal_kernel_types.h>
26#include <chdev.h>
27#include <dev_mmc.h>
28#include <soclib_mmc.h>
29#include <spinlock.h>
30#include <thread.h>
31#include <printk.h>
32
33
34///////////////////////////////////////
35void soclib_mmc_init( chdev_t * chdev )
36{
37    // get pointer on MMC segment base
38    uint32_t * base = (uint32_t *)GET_PTR( chdev->base );
39
40    // set driver specific fields in device descriptor
41    chdev->cmd = &soclib_mmc_cmd;
42    chdev->isr = &soclib_mmc_isr;
43
44    // enable MMC IRQ
45    *(base + (SOCLIB_MMC_ERROR_FUNC << 7) + SOCLIB_MMC_ERROR_IRQ_ENABLE) = 1;
46} 
47
48
49//////////////////////////////////////////////////////////////
50void __attribute__ ((noinline)) soclib_mmc_cmd( xptr_t th_xp )
51{
52    xptr_t     dev_xp;       // extended pointer on MMC device
53    uint32_t   type;         // MMC command : type
54    void     * buf_ptr;      // MMC command : buffer pointer
55    uint32_t   buf_size;     // MMC command : buffer size
56    uint32_t   reg_index;    // MMC command : register index in MMC peripheral
57    uint32_t * reg_ptr;      // MMC command : pointer on dst/src buffer in client cluster
58
59    // get client thread cluster and local pointer
60    cxy_t      th_cxy = GET_CXY( th_xp );
61    thread_t * th_ptr = GET_PTR( th_xp );
62
63    // get command type and extended pointer on MMC device
64    type   =         hal_remote_lw ( XPTR( th_cxy , &th_ptr->mmc_cmd.type   ) );
65    dev_xp = (xptr_t)hal_remote_lwd( XPTR( th_cxy , &th_ptr->mmc_cmd.dev_xp ) );
66
67    // get MMC device cluster and local pointer
68    cxy_t     dev_cxy = GET_CXY( dev_xp );
69    chdev_t * dev_ptr = GET_PTR( dev_xp );
70
71    // get cluster and pointers for SOCLIB_MMC peripheral segment base
72    xptr_t     seg_xp = (xptr_t)hal_remote_lwd( XPTR( dev_cxy , &dev_ptr->base ) );
73    cxy_t      seg_cxy = GET_CXY( seg_xp );
74    uint32_t * seg_ptr = GET_PTR( seg_xp );
75
76    if( (type == MMC_CC_INVAL) || (type == MMC_CC_SYNC) )
77    {
78        // get buffer pointer and size
79        buf_ptr  = hal_remote_lpt( XPTR( th_cxy , &th_ptr->mmc_cmd.buf_ptr ) );
80        buf_size = hal_remote_lw ( XPTR( th_cxy , &th_ptr->mmc_cmd.buf_size ) );
81
82        // set command type
83        uint32_t   cc_cmd;
84        if( type == MMC_CC_INVAL )  cc_cmd = SOCLIB_MMC_CC_INVAL;
85        else                        cc_cmd = SOCLIB_MMC_CC_SYNC; 
86
87        // set SOCLIB_MMC registers to start INVAL/SYNC operation
88        hal_remote_sw( XPTR( seg_cxy , seg_ptr + SOCLIB_MMC_ADDR_LO    ) , (uint32_t)buf_ptr );
89        hal_remote_sw( XPTR( seg_cxy , seg_ptr + SOCLIB_MMC_ADDR_HI    ) , (uint32_t)dev_cxy );
90        hal_remote_sw( XPTR( seg_cxy , seg_ptr + SOCLIB_MMC_BUF_LENGTH ) , buf_size ); 
91        hal_remote_sw( XPTR( seg_cxy , seg_ptr + SOCLIB_MMC_CMD_TYPE   ) , cc_cmd ); 
92    }
93    else  // (type == MMC_GET_ERROR) or (type == MMC_GET_ERROR) pr (type == MMC_GET_INSTRU )
94    {
95        // get src/dst buffer local pointer and register index
96        reg_ptr   = (uint32_t *)hal_remote_lpt( XPTR( th_cxy , &th_ptr->mmc_cmd.reg_ptr ) );
97        reg_index = hal_remote_lw( XPTR( th_cxy , &th_ptr->mmc_cmd.reg_index ) );
98
99        // move register to/from local buffer
100        if( (type == MMC_GET_ERROR) || (type == MMC_GET_INSTRU) )
101        {
102            *reg_ptr =  hal_remote_lw( XPTR( seg_cxy , seg_ptr + reg_index ) );
103        }
104        else  // type == MMC_SET_ERROR
105        {
106            hal_remote_sw( XPTR( seg_cxy , seg_ptr + reg_index ) , *reg_ptr );
107        }
108    }
109} // end soclib_mmc_cmd()
110
111
112////////////////////////////////////////////////////////////////
113void __attribute__ ((noinline)) soclib_mmc_isr( chdev_t * chdev )
114{
115    // get pointer on MMC segment base
116    uint32_t * base = (uint32_t *)GET_PTR( chdev->base );
117
118    // get faulty ADDRESS and SRCID from MMC registers
119    uint32_t paddr_lo = *(base + (SOCLIB_MMC_ERROR_FUNC << 7) + SOCLIB_MMC_ERROR_ADDR_LO);
120    uint32_t paddr_hi = *(base + (SOCLIB_MMC_ERROR_FUNC << 7) + SOCLIB_MMC_ERROR_ADDR_HI);
121    uint32_t srcid    = *(base + (SOCLIB_MMC_ERROR_FUNC << 7) + SOCLIB_MMC_ERROR_SRCID);
122
123    paddr_t paddr = (((paddr_t)paddr_hi)<<32) + ((paddr_t)paddr_lo);
124   
125    // reset MMC IRQ
126    *(base + (SOCLIB_MMC_ERROR_FUNC << 7) + SOCLIB_MMC_ERROR_IRQ_RESET) = 0;
127   
128    // print an error message on kernel terminal TODO : should be improved
129    printk("\n[ERROR] reported from MMC in cluster %x : faulty address = %l / srcid = %x\n",
130           paddr , srcid );
131
132} // end soclib_mmc_isr()
133
134
135
Note: See TracBrowser for help on using the repository browser.