From 3a0d3f286be62b4933ba404187aff23cae166a5a Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Jonny=20Sv=C3=A4rd?= Date: Thu, 18 Mar 2021 15:31:50 +0100 Subject: Add timing adapter driver Change-Id: I90e0c7be29acbfc51ac801e343a5f9171152678e --- drivers/timing_adapter/src/timing_adapter.c | 215 ++++++++++++++++++++++++++++ 1 file changed, 215 insertions(+) create mode 100644 drivers/timing_adapter/src/timing_adapter.c (limited to 'drivers/timing_adapter/src/timing_adapter.c') diff --git a/drivers/timing_adapter/src/timing_adapter.c b/drivers/timing_adapter/src/timing_adapter.c new file mode 100644 index 0000000..65e4178 --- /dev/null +++ b/drivers/timing_adapter/src/timing_adapter.c @@ -0,0 +1,215 @@ +/* + * Copyright (c) 2020-2021 Arm Limited. All rights reserved. + * + * SPDX-License-Identifier: Apache-2.0 + * + * Licensed under the Apache License, Version 2.0 (the License); you may + * not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an AS IS BASIS, WITHOUT + * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#include +#include + +// Register offsets +#define TA_MAXR 0x00 +#define TA_MAXW 0x04 +#define TA_MAXRW 0x08 +#define TA_RLATENCY 0x0C +#define TA_WLATENCY 0x10 +#define TA_PULSE_ON 0x14 +#define TA_PULSE_OFF 0x18 +#define TA_BWCAP 0x1C +#define TA_PERFCTRL 0x20 +#define TA_PERFCNT 0x24 +#define TA_MODE 0x28 +#define TA_MAXPENDING 0x2C +#define TA_HISTBIN 0x30 +#define TA_HISTCNT 0x34 +#define TA_VERSION 0x38 + +// Register masks +#define TA_MAXR_MASK 0x0000003F +#define TA_MAXW_MASK 0x0000003F +#define TA_MAXRW_MASK 0x0000003F +#define TA_RLATENCY_MASK 0x00000FFF +#define TA_WLATENCY_MASK 0x00000FFF +#define TA_PULSE_ON_MASK 0x0000FFFF +#define TA_PULSE_OFF_MASK 0x0000FFFF +#define TA_BWCAP_MASK 0x0000FFFF +#define TA_PERFCTRL_MASK 0x0000003F +#define TA_PERFCNT_MASK 0xFFFFFFFF +#define TA_MODE_MASK 0x00000FFF +#define TA_MAXPENDING_MASK 0xFFFFFFFF +#define TA_HISTBIN_MASK 0x0000000F +#define TA_HISTCNT_MASK 0xFFFFFFFF + +#define TA_VERSION_SUPPORTED 0x1117 + +int ta_init(struct timing_adapter *ta, uintptr_t base_addr) { + ta->base_addr = base_addr; + + if (ta_get_version(ta) != TA_VERSION_SUPPORTED) { + return -1; + } + return 0; +} + +void ta_uninit(struct timing_adapter *ta) { + ta->base_addr = 0; +} + +// -- Set API -------------------------------------- +void ta_set_all(struct timing_adapter *ta, struct timing_adapter_settings *in) { + ta_set_maxr(ta, in->maxr); + ta_set_maxw(ta, in->maxw); + ta_set_maxrw(ta, in->maxrw); + ta_set_rlatency(ta, in->rlatency); + ta_set_wlatency(ta, in->wlatency); + ta_set_pulse_on(ta, in->pulse_on); + ta_set_pulse_off(ta, in->pulse_off); + ta_set_bwcap(ta, in->bwcap); + ta_set_perfctrl(ta, in->perfctrl); + ta_set_perfcnt(ta, in->perfcnt); + ta_set_mode(ta, in->mode); + ta_set_histbin(ta, in->histbin); + ta_set_histcnt(ta, in->histcnt); +} + +void ta_set_maxr(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_MAXR) = val & TA_MAXR_MASK; +}; + +void ta_set_maxw(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_MAXW) = val & TA_MAXW_MASK; +}; + +void ta_set_maxrw(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_MAXRW) = val & TA_MAXRW_MASK; +}; + +void ta_set_rlatency(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_RLATENCY) = val & TA_RLATENCY_MASK; +}; + +void ta_set_wlatency(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_WLATENCY) = val & TA_WLATENCY_MASK; +}; + +void ta_set_pulse_on(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_PULSE_ON) = val & TA_PULSE_ON_MASK; +}; + +void ta_set_pulse_off(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_PULSE_OFF) = val & TA_PULSE_OFF_MASK; +}; + +void ta_set_bwcap(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_BWCAP) = val & TA_BWCAP_MASK; +}; + +void ta_set_perfctrl(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_PERFCTRL) = val & TA_PERFCTRL_MASK; +}; + +void ta_set_perfcnt(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_PERFCNT) = val & TA_PERFCNT_MASK; +}; + +void ta_set_mode(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_MODE) = val & TA_MODE_MASK; +}; + +void ta_set_histbin(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_HISTBIN) = val & TA_HISTBIN_MASK; +}; + +void ta_set_histcnt(struct timing_adapter *ta, uint32_t val) { + *(volatile uint32_t *)(ta->base_addr + TA_HISTCNT) = val & TA_HISTCNT_MASK; +}; + +// -- Get API -------------------------------------- +void ta_get_all(struct timing_adapter *ta, struct timing_adapter_settings *out) { + out->maxr = ta_get_maxr(ta); + out->maxw = ta_get_maxw(ta); + out->maxrw = ta_get_maxrw(ta); + out->rlatency = ta_get_rlatency(ta); + out->wlatency = ta_get_wlatency(ta); + out->pulse_on = ta_get_pulse_on(ta); + out->pulse_off = ta_get_pulse_off(ta); + out->bwcap = ta_get_bwcap(ta); + out->perfctrl = ta_get_perfctrl(ta); + out->perfcnt = ta_get_perfcnt(ta); + out->mode = ta_get_mode(ta); + out->maxpending = ta_get_maxpending(ta); + out->histbin = ta_get_histbin(ta); + out->histcnt = ta_get_histcnt(ta); +} + +uint32_t ta_get_maxr(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_MAXR) & TA_MAXR_MASK; +}; + +uint32_t ta_get_maxw(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_MAXW) & TA_MAXW_MASK; +}; + +uint32_t ta_get_maxrw(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_MAXRW) & TA_MAXRW_MASK; +}; + +uint32_t ta_get_rlatency(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_RLATENCY) & TA_RLATENCY_MASK; +}; + +uint32_t ta_get_wlatency(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_WLATENCY) & TA_WLATENCY_MASK; +}; + +uint32_t ta_get_pulse_on(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_PULSE_ON) & TA_PULSE_ON_MASK; +}; + +uint32_t ta_get_pulse_off(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_PULSE_OFF) & TA_PULSE_OFF_MASK; +}; + +uint32_t ta_get_bwcap(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_BWCAP) & TA_BWCAP_MASK; +}; + +uint32_t ta_get_perfctrl(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_PERFCTRL) & TA_PERFCTRL_MASK; +}; + +uint32_t ta_get_perfcnt(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_PERFCNT) & TA_PERFCNT_MASK; +}; + +uint32_t ta_get_mode(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_MODE) & TA_MODE_MASK; +}; + +uint32_t ta_get_maxpending(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_MAXPENDING) & TA_MAXPENDING_MASK; +}; + +uint32_t ta_get_histbin(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_HISTBIN) & TA_HISTBIN_MASK; +}; + +uint32_t ta_get_histcnt(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_HISTCNT) & TA_HISTCNT_MASK; +}; + +uint32_t ta_get_version(struct timing_adapter *ta) { + return *(volatile uint32_t *)(ta->base_addr + TA_VERSION); +}; -- cgit v1.2.1