13a9f8eecSGrzegorz Jaszczyk /* 23a9f8eecSGrzegorz Jaszczyk * Copyright (C) 2018 Marvell International Ltd. 33a9f8eecSGrzegorz Jaszczyk * 43a9f8eecSGrzegorz Jaszczyk * SPDX-License-Identifier: BSD-3-Clause 53a9f8eecSGrzegorz Jaszczyk * https://spdx.org/licenses 63a9f8eecSGrzegorz Jaszczyk */ 73a9f8eecSGrzegorz Jaszczyk 8*09d40e0eSAntonio Nino Diaz #include <common/debug.h> 9*09d40e0eSAntonio Nino Diaz #include <drivers/marvell/addr_map.h> 10*09d40e0eSAntonio Nino Diaz #include <lib/mmio.h> 11*09d40e0eSAntonio Nino Diaz 123a9f8eecSGrzegorz Jaszczyk #include <mvebu_def.h> 13*09d40e0eSAntonio Nino Diaz 143a9f8eecSGrzegorz Jaszczyk #include "mc_trustzone.h" 153a9f8eecSGrzegorz Jaszczyk 163a9f8eecSGrzegorz Jaszczyk #define TZ_SIZE(x) ((x) >> 13) 173a9f8eecSGrzegorz Jaszczyk 183a9f8eecSGrzegorz Jaszczyk static int fls(int x) 193a9f8eecSGrzegorz Jaszczyk { 203a9f8eecSGrzegorz Jaszczyk if (!x) 213a9f8eecSGrzegorz Jaszczyk return 0; 223a9f8eecSGrzegorz Jaszczyk 233a9f8eecSGrzegorz Jaszczyk return 32 - __builtin_clz(x); 243a9f8eecSGrzegorz Jaszczyk } 253a9f8eecSGrzegorz Jaszczyk 263a9f8eecSGrzegorz Jaszczyk /* To not duplicate types, the addr_map_win is used, but the "target" 273a9f8eecSGrzegorz Jaszczyk * filed is referring to attributes instead of "target". 283a9f8eecSGrzegorz Jaszczyk */ 293a9f8eecSGrzegorz Jaszczyk void tz_enable_win(int ap_index, const struct addr_map_win *win, int win_id) 303a9f8eecSGrzegorz Jaszczyk { 313a9f8eecSGrzegorz Jaszczyk int tz_size; 323a9f8eecSGrzegorz Jaszczyk uint32_t val, base = win->base_addr; 333a9f8eecSGrzegorz Jaszczyk 343a9f8eecSGrzegorz Jaszczyk if ((win_id < 0) || (win_id > MVEBU_TZ_MAX_WINS)) { 353a9f8eecSGrzegorz Jaszczyk ERROR("Enabling wrong MC TrustZone window %d!\n", win_id); 363a9f8eecSGrzegorz Jaszczyk return; 373a9f8eecSGrzegorz Jaszczyk } 383a9f8eecSGrzegorz Jaszczyk 393a9f8eecSGrzegorz Jaszczyk /* map the window size to trustzone register convention */ 403a9f8eecSGrzegorz Jaszczyk tz_size = fls(TZ_SIZE(win->win_size)); 413a9f8eecSGrzegorz Jaszczyk 423a9f8eecSGrzegorz Jaszczyk VERBOSE("%s: window size = 0x%llx maps to tz_size %d\n", 433a9f8eecSGrzegorz Jaszczyk __func__, win->win_size, tz_size); 443a9f8eecSGrzegorz Jaszczyk if (tz_size < 0 || tz_size > 31) { 453a9f8eecSGrzegorz Jaszczyk ERROR("Using not allowed size for MC TrustZone window %d!\n", 463a9f8eecSGrzegorz Jaszczyk win_id); 473a9f8eecSGrzegorz Jaszczyk return; 483a9f8eecSGrzegorz Jaszczyk } 493a9f8eecSGrzegorz Jaszczyk 503a9f8eecSGrzegorz Jaszczyk if (base & 0xfff) { 513a9f8eecSGrzegorz Jaszczyk base = base & ~0xfff; 523a9f8eecSGrzegorz Jaszczyk WARN("Attempt to open MC TZ win. at 0x%llx, truncate to 0x%x\n", 533a9f8eecSGrzegorz Jaszczyk win->base_addr, base); 543a9f8eecSGrzegorz Jaszczyk } 553a9f8eecSGrzegorz Jaszczyk 563a9f8eecSGrzegorz Jaszczyk val = base | (tz_size << 7) | win->target_id | TZ_VALID; 573a9f8eecSGrzegorz Jaszczyk 583a9f8eecSGrzegorz Jaszczyk VERBOSE("%s: base 0x%x, tz_size moved 0x%x, attr 0x%x, val 0x%x\n", 593a9f8eecSGrzegorz Jaszczyk __func__, base, (tz_size << 7), win->target_id, val); 603a9f8eecSGrzegorz Jaszczyk 613a9f8eecSGrzegorz Jaszczyk mmio_write_32(MVEBU_AP_MC_TRUSTZONE_REG_LOW(ap_index, win_id), val); 623a9f8eecSGrzegorz Jaszczyk 633a9f8eecSGrzegorz Jaszczyk VERBOSE("%s: Win%d[0x%x] configured to 0x%x\n", __func__, win_id, 643a9f8eecSGrzegorz Jaszczyk MVEBU_AP_MC_TRUSTZONE_REG_LOW(ap_index, win_id), 653a9f8eecSGrzegorz Jaszczyk mmio_read_32(MVEBU_AP_MC_TRUSTZONE_REG_LOW(ap_index, win_id))); 663a9f8eecSGrzegorz Jaszczyk 673a9f8eecSGrzegorz Jaszczyk mmio_write_32(MVEBU_AP_MC_TRUSTZONE_REG_HIGH(ap_index, win_id), 683a9f8eecSGrzegorz Jaszczyk (win->base_addr >> 32)); 693a9f8eecSGrzegorz Jaszczyk 703a9f8eecSGrzegorz Jaszczyk VERBOSE("%s: Win%d[0x%x] configured to 0x%x\n", __func__, win_id, 713a9f8eecSGrzegorz Jaszczyk MVEBU_AP_MC_TRUSTZONE_REG_HIGH(ap_index, win_id), 723a9f8eecSGrzegorz Jaszczyk mmio_read_32(MVEBU_AP_MC_TRUSTZONE_REG_HIGH(ap_index, win_id))); 733a9f8eecSGrzegorz Jaszczyk } 74