[1] | 1 | /* |
---|
| 2 | * soclib_xcu.c - soclib XCU driver API implementation. |
---|
| 3 | * |
---|
| 4 | * Authors 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-kernel; if not, write to the Free Software Foundation, |
---|
| 21 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
---|
| 22 | */ |
---|
| 23 | |
---|
| 24 | #include <soclib_xcu.h> |
---|
| 25 | #include <hal_types.h> |
---|
| 26 | #include <core.h> |
---|
| 27 | #include <device.h> |
---|
| 28 | |
---|
| 29 | |
---|
| 30 | |
---|
| 31 | ///////////////////////////////////// |
---|
| 32 | void soclib_xcu_init( device_t * icu, |
---|
| 33 | lid_t lid ) |
---|
| 34 | { |
---|
| 35 | // get local ICU segment base address |
---|
| 36 | uint32_t * base = (uint32_t *)GET_PTR( icu->base ); |
---|
| 37 | |
---|
| 38 | // write into registers |
---|
| 39 | base[XCU_MSK_HWI_DISABLE << 5 | lid] = 0xFFFFFFFF; |
---|
| 40 | base[XCU_MSK_WTI_DISABLE << 5 | lid] = 0xFFFFFFFF; |
---|
| 41 | base[XCU_MSK_PTI_DISABLE << 5 | lid] = 0xFFFFFFFF; |
---|
| 42 | } |
---|
| 43 | |
---|
| 44 | /////////////////////////////////////////////// |
---|
| 45 | void soclib_xcu_disable_irq( xptr_t icu_xp, |
---|
| 46 | uint32_t mask, |
---|
| 47 | uint32_t type, |
---|
| 48 | lid_t lid ) |
---|
| 49 | { |
---|
| 50 | // get remote ICU cluster and local pointer |
---|
| 51 | cxy_t icu_cxy = GET_CXY( icu_xp ); |
---|
| 52 | device_t * icu_ptr = (device_t *)GET_PTR( icu_xp ); |
---|
| 53 | |
---|
| 54 | // get remote XCU segment base address |
---|
| 55 | xptr_t base = (xptr_t)hal_remote_lwd( XPTR( icu_cxy , &icu_ptr->base ) ); |
---|
| 56 | |
---|
| 57 | // compute xptr on relevant XCU mask register |
---|
| 58 | xptr_t reg_xp; |
---|
| 59 | if ( type == WTI_TYPE ) reg_xp = base + ((XCU_MSK_WTI_DISABLE << 5 | lid)<<2); |
---|
| 60 | else if( type == HWI_TYPE ) reg_xp = base + ((XCU_MSK_HWI_DISABLE << 5 | lid)<<2); |
---|
| 61 | else reg_xp = base + ((XCU_MSK_PTI_DISABLE << 5 | lid)<<2); |
---|
| 62 | |
---|
| 63 | // reset relevant XCU mask register |
---|
| 64 | hal_remote_sw( reg_xp , mask ); |
---|
| 65 | } |
---|
| 66 | |
---|
| 67 | ////////////////////////////////////////////// |
---|
| 68 | void soclib_xcu_enable_irq( xptr_t icu_xp, |
---|
| 69 | uint32_t mask, |
---|
| 70 | uint32_t type, |
---|
| 71 | lid_t lid ) |
---|
| 72 | { |
---|
| 73 | // get remote ICU cluster and local pointer |
---|
| 74 | cxy_t icu_cxy = GET_CXY( icu_xp ); |
---|
| 75 | device_t * icu_ptr = (device_t *)GET_PTR( icu_xp ); |
---|
| 76 | |
---|
| 77 | // get remote XCU segment base address |
---|
| 78 | xptr_t base = (xptr_t)hal_remote_lwd( XPTR( icu_cxy , &icu_ptr->base ) ); |
---|
| 79 | |
---|
| 80 | // compute xptr on relevant XCU mask register |
---|
| 81 | xptr_t reg_xp; |
---|
| 82 | if ( type == WTI_TYPE ) reg_xp = base + ((XCU_MSK_WTI_ENABLE << 5 | lid)<<2); |
---|
| 83 | else if( type == HWI_TYPE ) reg_xp = base + ((XCU_MSK_HWI_ENABLE << 5 | lid)<<2); |
---|
| 84 | else reg_xp = base + ((XCU_MSK_PTI_ENABLE << 5 | lid)<<2); |
---|
| 85 | |
---|
| 86 | // set relevant XCU mask register |
---|
| 87 | hal_remote_sw( reg_xp , mask ); |
---|
| 88 | } |
---|
| 89 | |
---|
| 90 | /////////////////////////////////////////// |
---|
| 91 | void soclib_xcu_set_period( device_t * icu, |
---|
| 92 | uint32_t index, |
---|
| 93 | uint32_t period ) |
---|
| 94 | { |
---|
| 95 | // get local ICU segment base address |
---|
| 96 | uint32_t * base = (uint32_t *)GET_PTR( icu->base ); |
---|
| 97 | |
---|
| 98 | // write into register |
---|
| 99 | base[XCU_PTI_PER << 5 | index] = period; |
---|
| 100 | } |
---|
| 101 | |
---|
| 102 | ////////////////////////////////////////////// |
---|
| 103 | uint32_t soclib_xcu_ack_timer( device_t * icu, |
---|
| 104 | uint32_t index ) |
---|
| 105 | { |
---|
| 106 | // get local ICU segment base address |
---|
| 107 | uint32_t * base = (uint32_t *)GET_PTR( icu->base ); |
---|
| 108 | |
---|
| 109 | // read from register |
---|
| 110 | return base[XCU_PTI_ACK << 5 | index]; |
---|
| 111 | } |
---|
| 112 | |
---|
| 113 | /////////////////////////////////////////////// |
---|
| 114 | void soclib_xcu_get_status( device_t * icu, |
---|
| 115 | lid_t lid, |
---|
| 116 | uint32_t * hwi_status, |
---|
| 117 | uint32_t * wti_status, |
---|
| 118 | uint32_t * pti_status ) |
---|
| 119 | { |
---|
| 120 | // get local ICU segment base address |
---|
| 121 | uint32_t * base = (uint32_t *)GET_PTR( icu->base ); |
---|
| 122 | |
---|
| 123 | // read PRIO register |
---|
| 124 | uint32_t prio = base[XCU_PRIO << 5 | lid]; |
---|
| 125 | |
---|
| 126 | if( prio & 0x4 ) *wti_status = ((prio >> 24) & 0x1F) + 1; |
---|
| 127 | if( prio & 0x2 ) *hwi_status = ((prio >> 16) & 0x1F) + 1; |
---|
| 128 | if( prio & 0x1 ) *pti_status = ((prio >> 8) & 0x1F) + 1; |
---|
| 129 | } |
---|
| 130 | |
---|
| 131 | ///////////////////////////////////////// |
---|
| 132 | void soclib_xcu_send_ipi( xptr_t xp_icu, |
---|
| 133 | lid_t lid ) |
---|
| 134 | { |
---|
| 135 | // get target ICU device cluster and local pointer |
---|
| 136 | cxy_t cxy_icu = GET_CXY( xp_icu ); |
---|
| 137 | device_t * ptr_icu = (device_t *)GET_PTR( xp_icu ); |
---|
| 138 | |
---|
| 139 | // get extended pointer on target ICU segment base |
---|
| 140 | xptr_t xp_base = (xptr_t)hal_remote_lwd( XPTR( cxy_icu , &ptr_icu->base ) ); |
---|
| 141 | |
---|
| 142 | // get remote ICU segment local pointer |
---|
| 143 | uint32_t * base = (uint32_t *)GET_PTR( xp_base ); |
---|
| 144 | |
---|
| 145 | // send IPI to remote core |
---|
| 146 | hal_remote_sw( XPTR( cxy_icu , &base[XCU_WTI_REG << 5 | lid] ) , 0 ); |
---|
| 147 | } |
---|
| 148 | |
---|
| 149 | ////////////////////////////////////////////// |
---|
| 150 | uint32_t * soclib_xcu_wti_ptr( device_t * icu, |
---|
| 151 | uint32_t index ) |
---|
| 152 | { |
---|
| 153 | uint32_t * base = (uint32_t *)GET_PTR( icu->base ); |
---|
| 154 | |
---|
| 155 | return &base[XCU_WTI_REG << 5 | index]; |
---|
| 156 | } |
---|