18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Intel(R) Trace Hub Global Trace Hub 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright (C) 2014-2015 Intel Corporation. 68c2ecf20Sopenharmony_ci */ 78c2ecf20Sopenharmony_ci 88c2ecf20Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 98c2ecf20Sopenharmony_ci 108c2ecf20Sopenharmony_ci#include <linux/types.h> 118c2ecf20Sopenharmony_ci#include <linux/module.h> 128c2ecf20Sopenharmony_ci#include <linux/device.h> 138c2ecf20Sopenharmony_ci#include <linux/io.h> 148c2ecf20Sopenharmony_ci#include <linux/mm.h> 158c2ecf20Sopenharmony_ci#include <linux/slab.h> 168c2ecf20Sopenharmony_ci#include <linux/bitmap.h> 178c2ecf20Sopenharmony_ci#include <linux/pm_runtime.h> 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ci#include "intel_th.h" 208c2ecf20Sopenharmony_ci#include "gth.h" 218c2ecf20Sopenharmony_ci 228c2ecf20Sopenharmony_cistruct gth_device; 238c2ecf20Sopenharmony_ci 248c2ecf20Sopenharmony_ci/** 258c2ecf20Sopenharmony_ci * struct gth_output - GTH view on an output port 268c2ecf20Sopenharmony_ci * @gth: backlink to the GTH device 278c2ecf20Sopenharmony_ci * @output: link to output device's output descriptor 288c2ecf20Sopenharmony_ci * @index: output port number 298c2ecf20Sopenharmony_ci * @port_type: one of GTH_* port type values 308c2ecf20Sopenharmony_ci * @master: bitmap of masters configured for this output 318c2ecf20Sopenharmony_ci */ 328c2ecf20Sopenharmony_cistruct gth_output { 338c2ecf20Sopenharmony_ci struct gth_device *gth; 348c2ecf20Sopenharmony_ci struct intel_th_output *output; 358c2ecf20Sopenharmony_ci unsigned int index; 368c2ecf20Sopenharmony_ci unsigned int port_type; 378c2ecf20Sopenharmony_ci DECLARE_BITMAP(master, TH_CONFIGURABLE_MASTERS + 1); 388c2ecf20Sopenharmony_ci}; 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_ci/** 418c2ecf20Sopenharmony_ci * struct gth_device - GTH device 428c2ecf20Sopenharmony_ci * @dev: driver core's device 438c2ecf20Sopenharmony_ci * @base: register window base address 448c2ecf20Sopenharmony_ci * @output_group: attributes describing output ports 458c2ecf20Sopenharmony_ci * @master_group: attributes describing master assignments 468c2ecf20Sopenharmony_ci * @output: output ports 478c2ecf20Sopenharmony_ci * @master: master/output port assignments 488c2ecf20Sopenharmony_ci * @gth_lock: serializes accesses to GTH bits 498c2ecf20Sopenharmony_ci */ 508c2ecf20Sopenharmony_cistruct gth_device { 518c2ecf20Sopenharmony_ci struct device *dev; 528c2ecf20Sopenharmony_ci void __iomem *base; 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci struct attribute_group output_group; 558c2ecf20Sopenharmony_ci struct attribute_group master_group; 568c2ecf20Sopenharmony_ci struct gth_output output[TH_POSSIBLE_OUTPUTS]; 578c2ecf20Sopenharmony_ci signed char master[TH_CONFIGURABLE_MASTERS + 1]; 588c2ecf20Sopenharmony_ci spinlock_t gth_lock; 598c2ecf20Sopenharmony_ci}; 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_cistatic void gth_output_set(struct gth_device *gth, int port, 628c2ecf20Sopenharmony_ci unsigned int config) 638c2ecf20Sopenharmony_ci{ 648c2ecf20Sopenharmony_ci unsigned long reg = port & 4 ? REG_GTH_GTHOPT1 : REG_GTH_GTHOPT0; 658c2ecf20Sopenharmony_ci u32 val; 668c2ecf20Sopenharmony_ci int shift = (port & 3) * 8; 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci val = ioread32(gth->base + reg); 698c2ecf20Sopenharmony_ci val &= ~(0xff << shift); 708c2ecf20Sopenharmony_ci val |= config << shift; 718c2ecf20Sopenharmony_ci iowrite32(val, gth->base + reg); 728c2ecf20Sopenharmony_ci} 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_cistatic unsigned int gth_output_get(struct gth_device *gth, int port) 758c2ecf20Sopenharmony_ci{ 768c2ecf20Sopenharmony_ci unsigned long reg = port & 4 ? REG_GTH_GTHOPT1 : REG_GTH_GTHOPT0; 778c2ecf20Sopenharmony_ci u32 val; 788c2ecf20Sopenharmony_ci int shift = (port & 3) * 8; 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_ci val = ioread32(gth->base + reg); 818c2ecf20Sopenharmony_ci val &= 0xff << shift; 828c2ecf20Sopenharmony_ci val >>= shift; 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_ci return val; 858c2ecf20Sopenharmony_ci} 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_cistatic void gth_smcfreq_set(struct gth_device *gth, int port, 888c2ecf20Sopenharmony_ci unsigned int freq) 898c2ecf20Sopenharmony_ci{ 908c2ecf20Sopenharmony_ci unsigned long reg = REG_GTH_SMCR0 + ((port / 2) * 4); 918c2ecf20Sopenharmony_ci int shift = (port & 1) * 16; 928c2ecf20Sopenharmony_ci u32 val; 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_ci val = ioread32(gth->base + reg); 958c2ecf20Sopenharmony_ci val &= ~(0xffff << shift); 968c2ecf20Sopenharmony_ci val |= freq << shift; 978c2ecf20Sopenharmony_ci iowrite32(val, gth->base + reg); 988c2ecf20Sopenharmony_ci} 998c2ecf20Sopenharmony_ci 1008c2ecf20Sopenharmony_cistatic unsigned int gth_smcfreq_get(struct gth_device *gth, int port) 1018c2ecf20Sopenharmony_ci{ 1028c2ecf20Sopenharmony_ci unsigned long reg = REG_GTH_SMCR0 + ((port / 2) * 4); 1038c2ecf20Sopenharmony_ci int shift = (port & 1) * 16; 1048c2ecf20Sopenharmony_ci u32 val; 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_ci val = ioread32(gth->base + reg); 1078c2ecf20Sopenharmony_ci val &= 0xffff << shift; 1088c2ecf20Sopenharmony_ci val >>= shift; 1098c2ecf20Sopenharmony_ci 1108c2ecf20Sopenharmony_ci return val; 1118c2ecf20Sopenharmony_ci} 1128c2ecf20Sopenharmony_ci 1138c2ecf20Sopenharmony_ci/* 1148c2ecf20Sopenharmony_ci * "masters" attribute group 1158c2ecf20Sopenharmony_ci */ 1168c2ecf20Sopenharmony_ci 1178c2ecf20Sopenharmony_cistruct master_attribute { 1188c2ecf20Sopenharmony_ci struct device_attribute attr; 1198c2ecf20Sopenharmony_ci struct gth_device *gth; 1208c2ecf20Sopenharmony_ci unsigned int master; 1218c2ecf20Sopenharmony_ci}; 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_cistatic void 1248c2ecf20Sopenharmony_cigth_master_set(struct gth_device *gth, unsigned int master, int port) 1258c2ecf20Sopenharmony_ci{ 1268c2ecf20Sopenharmony_ci unsigned int reg = REG_GTH_SWDEST0 + ((master >> 1) & ~3u); 1278c2ecf20Sopenharmony_ci unsigned int shift = (master & 0x7) * 4; 1288c2ecf20Sopenharmony_ci u32 val; 1298c2ecf20Sopenharmony_ci 1308c2ecf20Sopenharmony_ci if (master >= 256) { 1318c2ecf20Sopenharmony_ci reg = REG_GTH_GSWTDEST; 1328c2ecf20Sopenharmony_ci shift = 0; 1338c2ecf20Sopenharmony_ci } 1348c2ecf20Sopenharmony_ci 1358c2ecf20Sopenharmony_ci val = ioread32(gth->base + reg); 1368c2ecf20Sopenharmony_ci val &= ~(0xf << shift); 1378c2ecf20Sopenharmony_ci if (port >= 0) 1388c2ecf20Sopenharmony_ci val |= (0x8 | port) << shift; 1398c2ecf20Sopenharmony_ci iowrite32(val, gth->base + reg); 1408c2ecf20Sopenharmony_ci} 1418c2ecf20Sopenharmony_ci 1428c2ecf20Sopenharmony_cistatic ssize_t master_attr_show(struct device *dev, 1438c2ecf20Sopenharmony_ci struct device_attribute *attr, 1448c2ecf20Sopenharmony_ci char *buf) 1458c2ecf20Sopenharmony_ci{ 1468c2ecf20Sopenharmony_ci struct master_attribute *ma = 1478c2ecf20Sopenharmony_ci container_of(attr, struct master_attribute, attr); 1488c2ecf20Sopenharmony_ci struct gth_device *gth = ma->gth; 1498c2ecf20Sopenharmony_ci size_t count; 1508c2ecf20Sopenharmony_ci int port; 1518c2ecf20Sopenharmony_ci 1528c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 1538c2ecf20Sopenharmony_ci port = gth->master[ma->master]; 1548c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 1558c2ecf20Sopenharmony_ci 1568c2ecf20Sopenharmony_ci if (port >= 0) 1578c2ecf20Sopenharmony_ci count = snprintf(buf, PAGE_SIZE, "%x\n", port); 1588c2ecf20Sopenharmony_ci else 1598c2ecf20Sopenharmony_ci count = snprintf(buf, PAGE_SIZE, "disabled\n"); 1608c2ecf20Sopenharmony_ci 1618c2ecf20Sopenharmony_ci return count; 1628c2ecf20Sopenharmony_ci} 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_cistatic ssize_t master_attr_store(struct device *dev, 1658c2ecf20Sopenharmony_ci struct device_attribute *attr, 1668c2ecf20Sopenharmony_ci const char *buf, size_t count) 1678c2ecf20Sopenharmony_ci{ 1688c2ecf20Sopenharmony_ci struct master_attribute *ma = 1698c2ecf20Sopenharmony_ci container_of(attr, struct master_attribute, attr); 1708c2ecf20Sopenharmony_ci struct gth_device *gth = ma->gth; 1718c2ecf20Sopenharmony_ci int old_port, port; 1728c2ecf20Sopenharmony_ci 1738c2ecf20Sopenharmony_ci if (kstrtoint(buf, 10, &port) < 0) 1748c2ecf20Sopenharmony_ci return -EINVAL; 1758c2ecf20Sopenharmony_ci 1768c2ecf20Sopenharmony_ci if (port >= TH_POSSIBLE_OUTPUTS || port < -1) 1778c2ecf20Sopenharmony_ci return -EINVAL; 1788c2ecf20Sopenharmony_ci 1798c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 1808c2ecf20Sopenharmony_ci 1818c2ecf20Sopenharmony_ci /* disconnect from the previous output port, if any */ 1828c2ecf20Sopenharmony_ci old_port = gth->master[ma->master]; 1838c2ecf20Sopenharmony_ci if (old_port >= 0) { 1848c2ecf20Sopenharmony_ci gth->master[ma->master] = -1; 1858c2ecf20Sopenharmony_ci clear_bit(ma->master, gth->output[old_port].master); 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci /* 1888c2ecf20Sopenharmony_ci * if the port is active, program this setting, 1898c2ecf20Sopenharmony_ci * implies that runtime PM is on 1908c2ecf20Sopenharmony_ci */ 1918c2ecf20Sopenharmony_ci if (gth->output[old_port].output->active) 1928c2ecf20Sopenharmony_ci gth_master_set(gth, ma->master, -1); 1938c2ecf20Sopenharmony_ci } 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci /* connect to the new output port, if any */ 1968c2ecf20Sopenharmony_ci if (port >= 0) { 1978c2ecf20Sopenharmony_ci /* check if there's a driver for this port */ 1988c2ecf20Sopenharmony_ci if (!gth->output[port].output) { 1998c2ecf20Sopenharmony_ci count = -ENODEV; 2008c2ecf20Sopenharmony_ci goto unlock; 2018c2ecf20Sopenharmony_ci } 2028c2ecf20Sopenharmony_ci 2038c2ecf20Sopenharmony_ci set_bit(ma->master, gth->output[port].master); 2048c2ecf20Sopenharmony_ci 2058c2ecf20Sopenharmony_ci /* if the port is active, program this setting, see above */ 2068c2ecf20Sopenharmony_ci if (gth->output[port].output->active) 2078c2ecf20Sopenharmony_ci gth_master_set(gth, ma->master, port); 2088c2ecf20Sopenharmony_ci } 2098c2ecf20Sopenharmony_ci 2108c2ecf20Sopenharmony_ci gth->master[ma->master] = port; 2118c2ecf20Sopenharmony_ci 2128c2ecf20Sopenharmony_ciunlock: 2138c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 2148c2ecf20Sopenharmony_ci 2158c2ecf20Sopenharmony_ci return count; 2168c2ecf20Sopenharmony_ci} 2178c2ecf20Sopenharmony_ci 2188c2ecf20Sopenharmony_cistruct output_attribute { 2198c2ecf20Sopenharmony_ci struct device_attribute attr; 2208c2ecf20Sopenharmony_ci struct gth_device *gth; 2218c2ecf20Sopenharmony_ci unsigned int port; 2228c2ecf20Sopenharmony_ci unsigned int parm; 2238c2ecf20Sopenharmony_ci}; 2248c2ecf20Sopenharmony_ci 2258c2ecf20Sopenharmony_ci#define OUTPUT_PARM(_name, _mask, _r, _w, _what) \ 2268c2ecf20Sopenharmony_ci [TH_OUTPUT_PARM(_name)] = { .name = __stringify(_name), \ 2278c2ecf20Sopenharmony_ci .get = gth_ ## _what ## _get, \ 2288c2ecf20Sopenharmony_ci .set = gth_ ## _what ## _set, \ 2298c2ecf20Sopenharmony_ci .mask = (_mask), \ 2308c2ecf20Sopenharmony_ci .readable = (_r), \ 2318c2ecf20Sopenharmony_ci .writable = (_w) } 2328c2ecf20Sopenharmony_ci 2338c2ecf20Sopenharmony_cistatic const struct output_parm { 2348c2ecf20Sopenharmony_ci const char *name; 2358c2ecf20Sopenharmony_ci unsigned int (*get)(struct gth_device *gth, int port); 2368c2ecf20Sopenharmony_ci void (*set)(struct gth_device *gth, int port, 2378c2ecf20Sopenharmony_ci unsigned int val); 2388c2ecf20Sopenharmony_ci unsigned int mask; 2398c2ecf20Sopenharmony_ci unsigned int readable : 1, 2408c2ecf20Sopenharmony_ci writable : 1; 2418c2ecf20Sopenharmony_ci} output_parms[] = { 2428c2ecf20Sopenharmony_ci OUTPUT_PARM(port, 0x7, 1, 0, output), 2438c2ecf20Sopenharmony_ci OUTPUT_PARM(null, BIT(3), 1, 1, output), 2448c2ecf20Sopenharmony_ci OUTPUT_PARM(drop, BIT(4), 1, 1, output), 2458c2ecf20Sopenharmony_ci OUTPUT_PARM(reset, BIT(5), 1, 0, output), 2468c2ecf20Sopenharmony_ci OUTPUT_PARM(flush, BIT(7), 0, 1, output), 2478c2ecf20Sopenharmony_ci OUTPUT_PARM(smcfreq, 0xffff, 1, 1, smcfreq), 2488c2ecf20Sopenharmony_ci}; 2498c2ecf20Sopenharmony_ci 2508c2ecf20Sopenharmony_cistatic void 2518c2ecf20Sopenharmony_cigth_output_parm_set(struct gth_device *gth, int port, unsigned int parm, 2528c2ecf20Sopenharmony_ci unsigned int val) 2538c2ecf20Sopenharmony_ci{ 2548c2ecf20Sopenharmony_ci unsigned int config = output_parms[parm].get(gth, port); 2558c2ecf20Sopenharmony_ci unsigned int mask = output_parms[parm].mask; 2568c2ecf20Sopenharmony_ci unsigned int shift = __ffs(mask); 2578c2ecf20Sopenharmony_ci 2588c2ecf20Sopenharmony_ci config &= ~mask; 2598c2ecf20Sopenharmony_ci config |= (val << shift) & mask; 2608c2ecf20Sopenharmony_ci output_parms[parm].set(gth, port, config); 2618c2ecf20Sopenharmony_ci} 2628c2ecf20Sopenharmony_ci 2638c2ecf20Sopenharmony_cistatic unsigned int 2648c2ecf20Sopenharmony_cigth_output_parm_get(struct gth_device *gth, int port, unsigned int parm) 2658c2ecf20Sopenharmony_ci{ 2668c2ecf20Sopenharmony_ci unsigned int config = output_parms[parm].get(gth, port); 2678c2ecf20Sopenharmony_ci unsigned int mask = output_parms[parm].mask; 2688c2ecf20Sopenharmony_ci unsigned int shift = __ffs(mask); 2698c2ecf20Sopenharmony_ci 2708c2ecf20Sopenharmony_ci config &= mask; 2718c2ecf20Sopenharmony_ci config >>= shift; 2728c2ecf20Sopenharmony_ci return config; 2738c2ecf20Sopenharmony_ci} 2748c2ecf20Sopenharmony_ci 2758c2ecf20Sopenharmony_ci/* 2768c2ecf20Sopenharmony_ci * Reset outputs and sources 2778c2ecf20Sopenharmony_ci */ 2788c2ecf20Sopenharmony_cistatic int intel_th_gth_reset(struct gth_device *gth) 2798c2ecf20Sopenharmony_ci{ 2808c2ecf20Sopenharmony_ci u32 reg; 2818c2ecf20Sopenharmony_ci int port, i; 2828c2ecf20Sopenharmony_ci 2838c2ecf20Sopenharmony_ci reg = ioread32(gth->base + REG_GTH_SCRPD0); 2848c2ecf20Sopenharmony_ci if (reg & SCRPD_DEBUGGER_IN_USE) 2858c2ecf20Sopenharmony_ci return -EBUSY; 2868c2ecf20Sopenharmony_ci 2878c2ecf20Sopenharmony_ci /* Always save/restore STH and TU registers in S0ix entry/exit */ 2888c2ecf20Sopenharmony_ci reg |= SCRPD_STH_IS_ENABLED | SCRPD_TRIGGER_IS_ENABLED; 2898c2ecf20Sopenharmony_ci iowrite32(reg, gth->base + REG_GTH_SCRPD0); 2908c2ecf20Sopenharmony_ci 2918c2ecf20Sopenharmony_ci /* output ports */ 2928c2ecf20Sopenharmony_ci for (port = 0; port < 8; port++) { 2938c2ecf20Sopenharmony_ci if (gth_output_parm_get(gth, port, TH_OUTPUT_PARM(port)) == 2948c2ecf20Sopenharmony_ci GTH_NONE) 2958c2ecf20Sopenharmony_ci continue; 2968c2ecf20Sopenharmony_ci 2978c2ecf20Sopenharmony_ci gth_output_set(gth, port, 0); 2988c2ecf20Sopenharmony_ci gth_smcfreq_set(gth, port, 16); 2998c2ecf20Sopenharmony_ci } 3008c2ecf20Sopenharmony_ci /* disable overrides */ 3018c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_GTH_DESTOVR); 3028c2ecf20Sopenharmony_ci 3038c2ecf20Sopenharmony_ci /* masters swdest_0~31 and gswdest */ 3048c2ecf20Sopenharmony_ci for (i = 0; i < 33; i++) 3058c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_GTH_SWDEST0 + i * 4); 3068c2ecf20Sopenharmony_ci 3078c2ecf20Sopenharmony_ci /* sources */ 3088c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_GTH_SCR); 3098c2ecf20Sopenharmony_ci iowrite32(0xfc, gth->base + REG_GTH_SCR2); 3108c2ecf20Sopenharmony_ci 3118c2ecf20Sopenharmony_ci /* setup CTS for single trigger */ 3128c2ecf20Sopenharmony_ci iowrite32(CTS_EVENT_ENABLE_IF_ANYTHING, gth->base + REG_CTS_C0S0_EN); 3138c2ecf20Sopenharmony_ci iowrite32(CTS_ACTION_CONTROL_SET_STATE(CTS_STATE_IDLE) | 3148c2ecf20Sopenharmony_ci CTS_ACTION_CONTROL_TRIGGER, gth->base + REG_CTS_C0S0_ACT); 3158c2ecf20Sopenharmony_ci 3168c2ecf20Sopenharmony_ci return 0; 3178c2ecf20Sopenharmony_ci} 3188c2ecf20Sopenharmony_ci 3198c2ecf20Sopenharmony_ci/* 3208c2ecf20Sopenharmony_ci * "outputs" attribute group 3218c2ecf20Sopenharmony_ci */ 3228c2ecf20Sopenharmony_ci 3238c2ecf20Sopenharmony_cistatic ssize_t output_attr_show(struct device *dev, 3248c2ecf20Sopenharmony_ci struct device_attribute *attr, 3258c2ecf20Sopenharmony_ci char *buf) 3268c2ecf20Sopenharmony_ci{ 3278c2ecf20Sopenharmony_ci struct output_attribute *oa = 3288c2ecf20Sopenharmony_ci container_of(attr, struct output_attribute, attr); 3298c2ecf20Sopenharmony_ci struct gth_device *gth = oa->gth; 3308c2ecf20Sopenharmony_ci size_t count; 3318c2ecf20Sopenharmony_ci 3328c2ecf20Sopenharmony_ci pm_runtime_get_sync(dev); 3338c2ecf20Sopenharmony_ci 3348c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 3358c2ecf20Sopenharmony_ci count = snprintf(buf, PAGE_SIZE, "%x\n", 3368c2ecf20Sopenharmony_ci gth_output_parm_get(gth, oa->port, oa->parm)); 3378c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 3388c2ecf20Sopenharmony_ci 3398c2ecf20Sopenharmony_ci pm_runtime_put(dev); 3408c2ecf20Sopenharmony_ci 3418c2ecf20Sopenharmony_ci return count; 3428c2ecf20Sopenharmony_ci} 3438c2ecf20Sopenharmony_ci 3448c2ecf20Sopenharmony_cistatic ssize_t output_attr_store(struct device *dev, 3458c2ecf20Sopenharmony_ci struct device_attribute *attr, 3468c2ecf20Sopenharmony_ci const char *buf, size_t count) 3478c2ecf20Sopenharmony_ci{ 3488c2ecf20Sopenharmony_ci struct output_attribute *oa = 3498c2ecf20Sopenharmony_ci container_of(attr, struct output_attribute, attr); 3508c2ecf20Sopenharmony_ci struct gth_device *gth = oa->gth; 3518c2ecf20Sopenharmony_ci unsigned int config; 3528c2ecf20Sopenharmony_ci 3538c2ecf20Sopenharmony_ci if (kstrtouint(buf, 16, &config) < 0) 3548c2ecf20Sopenharmony_ci return -EINVAL; 3558c2ecf20Sopenharmony_ci 3568c2ecf20Sopenharmony_ci pm_runtime_get_sync(dev); 3578c2ecf20Sopenharmony_ci 3588c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 3598c2ecf20Sopenharmony_ci gth_output_parm_set(gth, oa->port, oa->parm, config); 3608c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci pm_runtime_put(dev); 3638c2ecf20Sopenharmony_ci 3648c2ecf20Sopenharmony_ci return count; 3658c2ecf20Sopenharmony_ci} 3668c2ecf20Sopenharmony_ci 3678c2ecf20Sopenharmony_cistatic int intel_th_master_attributes(struct gth_device *gth) 3688c2ecf20Sopenharmony_ci{ 3698c2ecf20Sopenharmony_ci struct master_attribute *master_attrs; 3708c2ecf20Sopenharmony_ci struct attribute **attrs; 3718c2ecf20Sopenharmony_ci int i, nattrs = TH_CONFIGURABLE_MASTERS + 2; 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_ci attrs = devm_kcalloc(gth->dev, nattrs, sizeof(void *), GFP_KERNEL); 3748c2ecf20Sopenharmony_ci if (!attrs) 3758c2ecf20Sopenharmony_ci return -ENOMEM; 3768c2ecf20Sopenharmony_ci 3778c2ecf20Sopenharmony_ci master_attrs = devm_kcalloc(gth->dev, nattrs, 3788c2ecf20Sopenharmony_ci sizeof(struct master_attribute), 3798c2ecf20Sopenharmony_ci GFP_KERNEL); 3808c2ecf20Sopenharmony_ci if (!master_attrs) 3818c2ecf20Sopenharmony_ci return -ENOMEM; 3828c2ecf20Sopenharmony_ci 3838c2ecf20Sopenharmony_ci for (i = 0; i < TH_CONFIGURABLE_MASTERS + 1; i++) { 3848c2ecf20Sopenharmony_ci char *name; 3858c2ecf20Sopenharmony_ci 3868c2ecf20Sopenharmony_ci name = devm_kasprintf(gth->dev, GFP_KERNEL, "%d%s", i, 3878c2ecf20Sopenharmony_ci i == TH_CONFIGURABLE_MASTERS ? "+" : ""); 3888c2ecf20Sopenharmony_ci if (!name) 3898c2ecf20Sopenharmony_ci return -ENOMEM; 3908c2ecf20Sopenharmony_ci 3918c2ecf20Sopenharmony_ci master_attrs[i].attr.attr.name = name; 3928c2ecf20Sopenharmony_ci master_attrs[i].attr.attr.mode = S_IRUGO | S_IWUSR; 3938c2ecf20Sopenharmony_ci master_attrs[i].attr.show = master_attr_show; 3948c2ecf20Sopenharmony_ci master_attrs[i].attr.store = master_attr_store; 3958c2ecf20Sopenharmony_ci 3968c2ecf20Sopenharmony_ci sysfs_attr_init(&master_attrs[i].attr.attr); 3978c2ecf20Sopenharmony_ci attrs[i] = &master_attrs[i].attr.attr; 3988c2ecf20Sopenharmony_ci 3998c2ecf20Sopenharmony_ci master_attrs[i].gth = gth; 4008c2ecf20Sopenharmony_ci master_attrs[i].master = i; 4018c2ecf20Sopenharmony_ci } 4028c2ecf20Sopenharmony_ci 4038c2ecf20Sopenharmony_ci gth->master_group.name = "masters"; 4048c2ecf20Sopenharmony_ci gth->master_group.attrs = attrs; 4058c2ecf20Sopenharmony_ci 4068c2ecf20Sopenharmony_ci return sysfs_create_group(>h->dev->kobj, >h->master_group); 4078c2ecf20Sopenharmony_ci} 4088c2ecf20Sopenharmony_ci 4098c2ecf20Sopenharmony_cistatic int intel_th_output_attributes(struct gth_device *gth) 4108c2ecf20Sopenharmony_ci{ 4118c2ecf20Sopenharmony_ci struct output_attribute *out_attrs; 4128c2ecf20Sopenharmony_ci struct attribute **attrs; 4138c2ecf20Sopenharmony_ci int i, j, nouts = TH_POSSIBLE_OUTPUTS; 4148c2ecf20Sopenharmony_ci int nparms = ARRAY_SIZE(output_parms); 4158c2ecf20Sopenharmony_ci int nattrs = nouts * nparms + 1; 4168c2ecf20Sopenharmony_ci 4178c2ecf20Sopenharmony_ci attrs = devm_kcalloc(gth->dev, nattrs, sizeof(void *), GFP_KERNEL); 4188c2ecf20Sopenharmony_ci if (!attrs) 4198c2ecf20Sopenharmony_ci return -ENOMEM; 4208c2ecf20Sopenharmony_ci 4218c2ecf20Sopenharmony_ci out_attrs = devm_kcalloc(gth->dev, nattrs, 4228c2ecf20Sopenharmony_ci sizeof(struct output_attribute), 4238c2ecf20Sopenharmony_ci GFP_KERNEL); 4248c2ecf20Sopenharmony_ci if (!out_attrs) 4258c2ecf20Sopenharmony_ci return -ENOMEM; 4268c2ecf20Sopenharmony_ci 4278c2ecf20Sopenharmony_ci for (i = 0; i < nouts; i++) { 4288c2ecf20Sopenharmony_ci for (j = 0; j < nparms; j++) { 4298c2ecf20Sopenharmony_ci unsigned int idx = i * nparms + j; 4308c2ecf20Sopenharmony_ci char *name; 4318c2ecf20Sopenharmony_ci 4328c2ecf20Sopenharmony_ci name = devm_kasprintf(gth->dev, GFP_KERNEL, "%d_%s", i, 4338c2ecf20Sopenharmony_ci output_parms[j].name); 4348c2ecf20Sopenharmony_ci if (!name) 4358c2ecf20Sopenharmony_ci return -ENOMEM; 4368c2ecf20Sopenharmony_ci 4378c2ecf20Sopenharmony_ci out_attrs[idx].attr.attr.name = name; 4388c2ecf20Sopenharmony_ci 4398c2ecf20Sopenharmony_ci if (output_parms[j].readable) { 4408c2ecf20Sopenharmony_ci out_attrs[idx].attr.attr.mode |= S_IRUGO; 4418c2ecf20Sopenharmony_ci out_attrs[idx].attr.show = output_attr_show; 4428c2ecf20Sopenharmony_ci } 4438c2ecf20Sopenharmony_ci 4448c2ecf20Sopenharmony_ci if (output_parms[j].writable) { 4458c2ecf20Sopenharmony_ci out_attrs[idx].attr.attr.mode |= S_IWUSR; 4468c2ecf20Sopenharmony_ci out_attrs[idx].attr.store = output_attr_store; 4478c2ecf20Sopenharmony_ci } 4488c2ecf20Sopenharmony_ci 4498c2ecf20Sopenharmony_ci sysfs_attr_init(&out_attrs[idx].attr.attr); 4508c2ecf20Sopenharmony_ci attrs[idx] = &out_attrs[idx].attr.attr; 4518c2ecf20Sopenharmony_ci 4528c2ecf20Sopenharmony_ci out_attrs[idx].gth = gth; 4538c2ecf20Sopenharmony_ci out_attrs[idx].port = i; 4548c2ecf20Sopenharmony_ci out_attrs[idx].parm = j; 4558c2ecf20Sopenharmony_ci } 4568c2ecf20Sopenharmony_ci } 4578c2ecf20Sopenharmony_ci 4588c2ecf20Sopenharmony_ci gth->output_group.name = "outputs"; 4598c2ecf20Sopenharmony_ci gth->output_group.attrs = attrs; 4608c2ecf20Sopenharmony_ci 4618c2ecf20Sopenharmony_ci return sysfs_create_group(>h->dev->kobj, >h->output_group); 4628c2ecf20Sopenharmony_ci} 4638c2ecf20Sopenharmony_ci 4648c2ecf20Sopenharmony_ci/** 4658c2ecf20Sopenharmony_ci * intel_th_gth_stop() - stop tracing to an output device 4668c2ecf20Sopenharmony_ci * @gth: GTH device 4678c2ecf20Sopenharmony_ci * @output: output device's descriptor 4688c2ecf20Sopenharmony_ci * @capture_done: set when no more traces will be captured 4698c2ecf20Sopenharmony_ci * 4708c2ecf20Sopenharmony_ci * This will stop tracing using force storeEn off signal and wait for the 4718c2ecf20Sopenharmony_ci * pipelines to be empty for the corresponding output port. 4728c2ecf20Sopenharmony_ci */ 4738c2ecf20Sopenharmony_cistatic void intel_th_gth_stop(struct gth_device *gth, 4748c2ecf20Sopenharmony_ci struct intel_th_output *output, 4758c2ecf20Sopenharmony_ci bool capture_done) 4768c2ecf20Sopenharmony_ci{ 4778c2ecf20Sopenharmony_ci struct intel_th_device *outdev = 4788c2ecf20Sopenharmony_ci container_of(output, struct intel_th_device, output); 4798c2ecf20Sopenharmony_ci struct intel_th_driver *outdrv = 4808c2ecf20Sopenharmony_ci to_intel_th_driver(outdev->dev.driver); 4818c2ecf20Sopenharmony_ci unsigned long count; 4828c2ecf20Sopenharmony_ci u32 reg; 4838c2ecf20Sopenharmony_ci u32 scr2 = 0xfc | (capture_done ? 1 : 0); 4848c2ecf20Sopenharmony_ci 4858c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_GTH_SCR); 4868c2ecf20Sopenharmony_ci iowrite32(scr2, gth->base + REG_GTH_SCR2); 4878c2ecf20Sopenharmony_ci 4888c2ecf20Sopenharmony_ci /* wait on pipeline empty for the given port */ 4898c2ecf20Sopenharmony_ci for (reg = 0, count = GTH_PLE_WAITLOOP_DEPTH; 4908c2ecf20Sopenharmony_ci count && !(reg & BIT(output->port)); count--) { 4918c2ecf20Sopenharmony_ci reg = ioread32(gth->base + REG_GTH_STAT); 4928c2ecf20Sopenharmony_ci cpu_relax(); 4938c2ecf20Sopenharmony_ci } 4948c2ecf20Sopenharmony_ci 4958c2ecf20Sopenharmony_ci if (!count) 4968c2ecf20Sopenharmony_ci dev_dbg(gth->dev, "timeout waiting for GTH[%d] PLE\n", 4978c2ecf20Sopenharmony_ci output->port); 4988c2ecf20Sopenharmony_ci 4998c2ecf20Sopenharmony_ci /* wait on output piepline empty */ 5008c2ecf20Sopenharmony_ci if (outdrv->wait_empty) 5018c2ecf20Sopenharmony_ci outdrv->wait_empty(outdev); 5028c2ecf20Sopenharmony_ci 5038c2ecf20Sopenharmony_ci /* clear force capture done for next captures */ 5048c2ecf20Sopenharmony_ci iowrite32(0xfc, gth->base + REG_GTH_SCR2); 5058c2ecf20Sopenharmony_ci} 5068c2ecf20Sopenharmony_ci 5078c2ecf20Sopenharmony_ci/** 5088c2ecf20Sopenharmony_ci * intel_th_gth_start() - start tracing to an output device 5098c2ecf20Sopenharmony_ci * @gth: GTH device 5108c2ecf20Sopenharmony_ci * @output: output device's descriptor 5118c2ecf20Sopenharmony_ci * 5128c2ecf20Sopenharmony_ci * This will start tracing using force storeEn signal. 5138c2ecf20Sopenharmony_ci */ 5148c2ecf20Sopenharmony_cistatic void intel_th_gth_start(struct gth_device *gth, 5158c2ecf20Sopenharmony_ci struct intel_th_output *output) 5168c2ecf20Sopenharmony_ci{ 5178c2ecf20Sopenharmony_ci u32 scr = 0xfc0000; 5188c2ecf20Sopenharmony_ci 5198c2ecf20Sopenharmony_ci if (output->multiblock) 5208c2ecf20Sopenharmony_ci scr |= 0xff; 5218c2ecf20Sopenharmony_ci 5228c2ecf20Sopenharmony_ci iowrite32(scr, gth->base + REG_GTH_SCR); 5238c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_GTH_SCR2); 5248c2ecf20Sopenharmony_ci} 5258c2ecf20Sopenharmony_ci 5268c2ecf20Sopenharmony_ci/** 5278c2ecf20Sopenharmony_ci * intel_th_gth_disable() - disable tracing to an output device 5288c2ecf20Sopenharmony_ci * @thdev: GTH device 5298c2ecf20Sopenharmony_ci * @output: output device's descriptor 5308c2ecf20Sopenharmony_ci * 5318c2ecf20Sopenharmony_ci * This will deconfigure all masters set to output to this device, 5328c2ecf20Sopenharmony_ci * disable tracing using force storeEn off signal and wait for the 5338c2ecf20Sopenharmony_ci * "pipeline empty" bit for corresponding output port. 5348c2ecf20Sopenharmony_ci */ 5358c2ecf20Sopenharmony_cistatic void intel_th_gth_disable(struct intel_th_device *thdev, 5368c2ecf20Sopenharmony_ci struct intel_th_output *output) 5378c2ecf20Sopenharmony_ci{ 5388c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 5398c2ecf20Sopenharmony_ci int master; 5408c2ecf20Sopenharmony_ci u32 reg; 5418c2ecf20Sopenharmony_ci 5428c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 5438c2ecf20Sopenharmony_ci output->active = false; 5448c2ecf20Sopenharmony_ci 5458c2ecf20Sopenharmony_ci for_each_set_bit(master, gth->output[output->port].master, 5468c2ecf20Sopenharmony_ci TH_CONFIGURABLE_MASTERS + 1) { 5478c2ecf20Sopenharmony_ci gth_master_set(gth, master, -1); 5488c2ecf20Sopenharmony_ci } 5498c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 5508c2ecf20Sopenharmony_ci 5518c2ecf20Sopenharmony_ci intel_th_gth_stop(gth, output, true); 5528c2ecf20Sopenharmony_ci 5538c2ecf20Sopenharmony_ci reg = ioread32(gth->base + REG_GTH_SCRPD0); 5548c2ecf20Sopenharmony_ci reg &= ~output->scratchpad; 5558c2ecf20Sopenharmony_ci iowrite32(reg, gth->base + REG_GTH_SCRPD0); 5568c2ecf20Sopenharmony_ci} 5578c2ecf20Sopenharmony_ci 5588c2ecf20Sopenharmony_cistatic void gth_tscu_resync(struct gth_device *gth) 5598c2ecf20Sopenharmony_ci{ 5608c2ecf20Sopenharmony_ci u32 reg; 5618c2ecf20Sopenharmony_ci 5628c2ecf20Sopenharmony_ci reg = ioread32(gth->base + REG_TSCU_TSUCTRL); 5638c2ecf20Sopenharmony_ci reg &= ~TSUCTRL_CTCRESYNC; 5648c2ecf20Sopenharmony_ci iowrite32(reg, gth->base + REG_TSCU_TSUCTRL); 5658c2ecf20Sopenharmony_ci} 5668c2ecf20Sopenharmony_ci 5678c2ecf20Sopenharmony_cistatic void intel_th_gth_prepare(struct intel_th_device *thdev, 5688c2ecf20Sopenharmony_ci struct intel_th_output *output) 5698c2ecf20Sopenharmony_ci{ 5708c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 5718c2ecf20Sopenharmony_ci int count; 5728c2ecf20Sopenharmony_ci 5738c2ecf20Sopenharmony_ci /* 5748c2ecf20Sopenharmony_ci * Wait until the output port is in reset before we start 5758c2ecf20Sopenharmony_ci * programming it. 5768c2ecf20Sopenharmony_ci */ 5778c2ecf20Sopenharmony_ci for (count = GTH_PLE_WAITLOOP_DEPTH; 5788c2ecf20Sopenharmony_ci count && !(gth_output_get(gth, output->port) & BIT(5)); count--) 5798c2ecf20Sopenharmony_ci cpu_relax(); 5808c2ecf20Sopenharmony_ci} 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci/** 5838c2ecf20Sopenharmony_ci * intel_th_gth_enable() - enable tracing to an output device 5848c2ecf20Sopenharmony_ci * @thdev: GTH device 5858c2ecf20Sopenharmony_ci * @output: output device's descriptor 5868c2ecf20Sopenharmony_ci * 5878c2ecf20Sopenharmony_ci * This will configure all masters set to output to this device and 5888c2ecf20Sopenharmony_ci * enable tracing using force storeEn signal. 5898c2ecf20Sopenharmony_ci */ 5908c2ecf20Sopenharmony_cistatic void intel_th_gth_enable(struct intel_th_device *thdev, 5918c2ecf20Sopenharmony_ci struct intel_th_output *output) 5928c2ecf20Sopenharmony_ci{ 5938c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 5948c2ecf20Sopenharmony_ci struct intel_th *th = to_intel_th(thdev); 5958c2ecf20Sopenharmony_ci int master; 5968c2ecf20Sopenharmony_ci u32 scrpd; 5978c2ecf20Sopenharmony_ci 5988c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 5998c2ecf20Sopenharmony_ci for_each_set_bit(master, gth->output[output->port].master, 6008c2ecf20Sopenharmony_ci TH_CONFIGURABLE_MASTERS + 1) { 6018c2ecf20Sopenharmony_ci gth_master_set(gth, master, output->port); 6028c2ecf20Sopenharmony_ci } 6038c2ecf20Sopenharmony_ci 6048c2ecf20Sopenharmony_ci output->active = true; 6058c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 6068c2ecf20Sopenharmony_ci 6078c2ecf20Sopenharmony_ci if (INTEL_TH_CAP(th, tscu_enable)) 6088c2ecf20Sopenharmony_ci gth_tscu_resync(gth); 6098c2ecf20Sopenharmony_ci 6108c2ecf20Sopenharmony_ci scrpd = ioread32(gth->base + REG_GTH_SCRPD0); 6118c2ecf20Sopenharmony_ci scrpd |= output->scratchpad; 6128c2ecf20Sopenharmony_ci iowrite32(scrpd, gth->base + REG_GTH_SCRPD0); 6138c2ecf20Sopenharmony_ci 6148c2ecf20Sopenharmony_ci intel_th_gth_start(gth, output); 6158c2ecf20Sopenharmony_ci} 6168c2ecf20Sopenharmony_ci 6178c2ecf20Sopenharmony_ci/** 6188c2ecf20Sopenharmony_ci * intel_th_gth_switch() - execute a switch sequence 6198c2ecf20Sopenharmony_ci * @thdev: GTH device 6208c2ecf20Sopenharmony_ci * @output: output device's descriptor 6218c2ecf20Sopenharmony_ci * 6228c2ecf20Sopenharmony_ci * This will execute a switch sequence that will trigger a switch window 6238c2ecf20Sopenharmony_ci * when tracing to MSC in multi-block mode. 6248c2ecf20Sopenharmony_ci */ 6258c2ecf20Sopenharmony_cistatic void intel_th_gth_switch(struct intel_th_device *thdev, 6268c2ecf20Sopenharmony_ci struct intel_th_output *output) 6278c2ecf20Sopenharmony_ci{ 6288c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 6298c2ecf20Sopenharmony_ci unsigned long count; 6308c2ecf20Sopenharmony_ci u32 reg; 6318c2ecf20Sopenharmony_ci 6328c2ecf20Sopenharmony_ci /* trigger */ 6338c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_CTS_CTL); 6348c2ecf20Sopenharmony_ci iowrite32(CTS_CTL_SEQUENCER_ENABLE, gth->base + REG_CTS_CTL); 6358c2ecf20Sopenharmony_ci /* wait on trigger status */ 6368c2ecf20Sopenharmony_ci for (reg = 0, count = CTS_TRIG_WAITLOOP_DEPTH; 6378c2ecf20Sopenharmony_ci count && !(reg & BIT(4)); count--) { 6388c2ecf20Sopenharmony_ci reg = ioread32(gth->base + REG_CTS_STAT); 6398c2ecf20Sopenharmony_ci cpu_relax(); 6408c2ecf20Sopenharmony_ci } 6418c2ecf20Sopenharmony_ci if (!count) 6428c2ecf20Sopenharmony_ci dev_dbg(&thdev->dev, "timeout waiting for CTS Trigger\n"); 6438c2ecf20Sopenharmony_ci 6448c2ecf20Sopenharmony_ci /* De-assert the trigger */ 6458c2ecf20Sopenharmony_ci iowrite32(0, gth->base + REG_CTS_CTL); 6468c2ecf20Sopenharmony_ci 6478c2ecf20Sopenharmony_ci intel_th_gth_stop(gth, output, false); 6488c2ecf20Sopenharmony_ci intel_th_gth_start(gth, output); 6498c2ecf20Sopenharmony_ci} 6508c2ecf20Sopenharmony_ci 6518c2ecf20Sopenharmony_ci/** 6528c2ecf20Sopenharmony_ci * intel_th_gth_assign() - assign output device to a GTH output port 6538c2ecf20Sopenharmony_ci * @thdev: GTH device 6548c2ecf20Sopenharmony_ci * @othdev: output device 6558c2ecf20Sopenharmony_ci * 6568c2ecf20Sopenharmony_ci * This will match a given output device parameters against present 6578c2ecf20Sopenharmony_ci * output ports on the GTH and fill out relevant bits in output device's 6588c2ecf20Sopenharmony_ci * descriptor. 6598c2ecf20Sopenharmony_ci * 6608c2ecf20Sopenharmony_ci * Return: 0 on success, -errno on error. 6618c2ecf20Sopenharmony_ci */ 6628c2ecf20Sopenharmony_cistatic int intel_th_gth_assign(struct intel_th_device *thdev, 6638c2ecf20Sopenharmony_ci struct intel_th_device *othdev) 6648c2ecf20Sopenharmony_ci{ 6658c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 6668c2ecf20Sopenharmony_ci int i, id; 6678c2ecf20Sopenharmony_ci 6688c2ecf20Sopenharmony_ci if (thdev->host_mode) 6698c2ecf20Sopenharmony_ci return -EBUSY; 6708c2ecf20Sopenharmony_ci 6718c2ecf20Sopenharmony_ci if (othdev->type != INTEL_TH_OUTPUT) 6728c2ecf20Sopenharmony_ci return -EINVAL; 6738c2ecf20Sopenharmony_ci 6748c2ecf20Sopenharmony_ci for (i = 0, id = 0; i < TH_POSSIBLE_OUTPUTS; i++) { 6758c2ecf20Sopenharmony_ci if (gth->output[i].port_type != othdev->output.type) 6768c2ecf20Sopenharmony_ci continue; 6778c2ecf20Sopenharmony_ci 6788c2ecf20Sopenharmony_ci if (othdev->id == -1 || othdev->id == id) 6798c2ecf20Sopenharmony_ci goto found; 6808c2ecf20Sopenharmony_ci 6818c2ecf20Sopenharmony_ci id++; 6828c2ecf20Sopenharmony_ci } 6838c2ecf20Sopenharmony_ci 6848c2ecf20Sopenharmony_ci return -ENOENT; 6858c2ecf20Sopenharmony_ci 6868c2ecf20Sopenharmony_cifound: 6878c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 6888c2ecf20Sopenharmony_ci othdev->output.port = i; 6898c2ecf20Sopenharmony_ci othdev->output.active = false; 6908c2ecf20Sopenharmony_ci gth->output[i].output = &othdev->output; 6918c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 6928c2ecf20Sopenharmony_ci 6938c2ecf20Sopenharmony_ci return 0; 6948c2ecf20Sopenharmony_ci} 6958c2ecf20Sopenharmony_ci 6968c2ecf20Sopenharmony_ci/** 6978c2ecf20Sopenharmony_ci * intel_th_gth_unassign() - deassociate an output device from its output port 6988c2ecf20Sopenharmony_ci * @thdev: GTH device 6998c2ecf20Sopenharmony_ci * @othdev: output device 7008c2ecf20Sopenharmony_ci */ 7018c2ecf20Sopenharmony_cistatic void intel_th_gth_unassign(struct intel_th_device *thdev, 7028c2ecf20Sopenharmony_ci struct intel_th_device *othdev) 7038c2ecf20Sopenharmony_ci{ 7048c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 7058c2ecf20Sopenharmony_ci int port = othdev->output.port; 7068c2ecf20Sopenharmony_ci int master; 7078c2ecf20Sopenharmony_ci 7088c2ecf20Sopenharmony_ci if (thdev->host_mode) 7098c2ecf20Sopenharmony_ci return; 7108c2ecf20Sopenharmony_ci 7118c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 7128c2ecf20Sopenharmony_ci othdev->output.port = -1; 7138c2ecf20Sopenharmony_ci othdev->output.active = false; 7148c2ecf20Sopenharmony_ci gth->output[port].output = NULL; 7158c2ecf20Sopenharmony_ci for (master = 0; master < TH_CONFIGURABLE_MASTERS + 1; master++) 7168c2ecf20Sopenharmony_ci if (gth->master[master] == port) 7178c2ecf20Sopenharmony_ci gth->master[master] = -1; 7188c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 7198c2ecf20Sopenharmony_ci} 7208c2ecf20Sopenharmony_ci 7218c2ecf20Sopenharmony_cistatic int 7228c2ecf20Sopenharmony_ciintel_th_gth_set_output(struct intel_th_device *thdev, unsigned int master) 7238c2ecf20Sopenharmony_ci{ 7248c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 7258c2ecf20Sopenharmony_ci int port = 0; /* FIXME: make default output configurable */ 7268c2ecf20Sopenharmony_ci 7278c2ecf20Sopenharmony_ci /* 7288c2ecf20Sopenharmony_ci * everything above TH_CONFIGURABLE_MASTERS is controlled by the 7298c2ecf20Sopenharmony_ci * same register 7308c2ecf20Sopenharmony_ci */ 7318c2ecf20Sopenharmony_ci if (master > TH_CONFIGURABLE_MASTERS) 7328c2ecf20Sopenharmony_ci master = TH_CONFIGURABLE_MASTERS; 7338c2ecf20Sopenharmony_ci 7348c2ecf20Sopenharmony_ci spin_lock(>h->gth_lock); 7358c2ecf20Sopenharmony_ci if (gth->master[master] == -1) { 7368c2ecf20Sopenharmony_ci set_bit(master, gth->output[port].master); 7378c2ecf20Sopenharmony_ci gth->master[master] = port; 7388c2ecf20Sopenharmony_ci } 7398c2ecf20Sopenharmony_ci spin_unlock(>h->gth_lock); 7408c2ecf20Sopenharmony_ci 7418c2ecf20Sopenharmony_ci return 0; 7428c2ecf20Sopenharmony_ci} 7438c2ecf20Sopenharmony_ci 7448c2ecf20Sopenharmony_cistatic int intel_th_gth_probe(struct intel_th_device *thdev) 7458c2ecf20Sopenharmony_ci{ 7468c2ecf20Sopenharmony_ci struct device *dev = &thdev->dev; 7478c2ecf20Sopenharmony_ci struct intel_th *th = dev_get_drvdata(dev->parent); 7488c2ecf20Sopenharmony_ci struct gth_device *gth; 7498c2ecf20Sopenharmony_ci struct resource *res; 7508c2ecf20Sopenharmony_ci void __iomem *base; 7518c2ecf20Sopenharmony_ci int i, ret; 7528c2ecf20Sopenharmony_ci 7538c2ecf20Sopenharmony_ci res = intel_th_device_get_resource(thdev, IORESOURCE_MEM, 0); 7548c2ecf20Sopenharmony_ci if (!res) 7558c2ecf20Sopenharmony_ci return -ENODEV; 7568c2ecf20Sopenharmony_ci 7578c2ecf20Sopenharmony_ci base = devm_ioremap(dev, res->start, resource_size(res)); 7588c2ecf20Sopenharmony_ci if (!base) 7598c2ecf20Sopenharmony_ci return -ENOMEM; 7608c2ecf20Sopenharmony_ci 7618c2ecf20Sopenharmony_ci gth = devm_kzalloc(dev, sizeof(*gth), GFP_KERNEL); 7628c2ecf20Sopenharmony_ci if (!gth) 7638c2ecf20Sopenharmony_ci return -ENOMEM; 7648c2ecf20Sopenharmony_ci 7658c2ecf20Sopenharmony_ci gth->dev = dev; 7668c2ecf20Sopenharmony_ci gth->base = base; 7678c2ecf20Sopenharmony_ci spin_lock_init(>h->gth_lock); 7688c2ecf20Sopenharmony_ci 7698c2ecf20Sopenharmony_ci dev_set_drvdata(dev, gth); 7708c2ecf20Sopenharmony_ci 7718c2ecf20Sopenharmony_ci /* 7728c2ecf20Sopenharmony_ci * Host mode can be signalled via SW means or via SCRPD_DEBUGGER_IN_USE 7738c2ecf20Sopenharmony_ci * bit. Either way, don't reset HW in this case, and don't export any 7748c2ecf20Sopenharmony_ci * capture configuration attributes. Also, refuse to assign output 7758c2ecf20Sopenharmony_ci * drivers to ports, see intel_th_gth_assign(). 7768c2ecf20Sopenharmony_ci */ 7778c2ecf20Sopenharmony_ci if (thdev->host_mode) 7788c2ecf20Sopenharmony_ci return 0; 7798c2ecf20Sopenharmony_ci 7808c2ecf20Sopenharmony_ci ret = intel_th_gth_reset(gth); 7818c2ecf20Sopenharmony_ci if (ret) { 7828c2ecf20Sopenharmony_ci if (ret != -EBUSY) 7838c2ecf20Sopenharmony_ci return ret; 7848c2ecf20Sopenharmony_ci 7858c2ecf20Sopenharmony_ci thdev->host_mode = true; 7868c2ecf20Sopenharmony_ci 7878c2ecf20Sopenharmony_ci return 0; 7888c2ecf20Sopenharmony_ci } 7898c2ecf20Sopenharmony_ci 7908c2ecf20Sopenharmony_ci for (i = 0; i < TH_CONFIGURABLE_MASTERS + 1; i++) 7918c2ecf20Sopenharmony_ci gth->master[i] = -1; 7928c2ecf20Sopenharmony_ci 7938c2ecf20Sopenharmony_ci for (i = 0; i < TH_POSSIBLE_OUTPUTS; i++) { 7948c2ecf20Sopenharmony_ci gth->output[i].gth = gth; 7958c2ecf20Sopenharmony_ci gth->output[i].index = i; 7968c2ecf20Sopenharmony_ci gth->output[i].port_type = 7978c2ecf20Sopenharmony_ci gth_output_parm_get(gth, i, TH_OUTPUT_PARM(port)); 7988c2ecf20Sopenharmony_ci if (gth->output[i].port_type == GTH_NONE) 7998c2ecf20Sopenharmony_ci continue; 8008c2ecf20Sopenharmony_ci 8018c2ecf20Sopenharmony_ci ret = intel_th_output_enable(th, gth->output[i].port_type); 8028c2ecf20Sopenharmony_ci /* -ENODEV is ok, we just won't have that device enumerated */ 8038c2ecf20Sopenharmony_ci if (ret && ret != -ENODEV) 8048c2ecf20Sopenharmony_ci return ret; 8058c2ecf20Sopenharmony_ci } 8068c2ecf20Sopenharmony_ci 8078c2ecf20Sopenharmony_ci if (intel_th_output_attributes(gth) || 8088c2ecf20Sopenharmony_ci intel_th_master_attributes(gth)) { 8098c2ecf20Sopenharmony_ci pr_warn("Can't initialize sysfs attributes\n"); 8108c2ecf20Sopenharmony_ci 8118c2ecf20Sopenharmony_ci if (gth->output_group.attrs) 8128c2ecf20Sopenharmony_ci sysfs_remove_group(>h->dev->kobj, >h->output_group); 8138c2ecf20Sopenharmony_ci return -ENOMEM; 8148c2ecf20Sopenharmony_ci } 8158c2ecf20Sopenharmony_ci 8168c2ecf20Sopenharmony_ci return 0; 8178c2ecf20Sopenharmony_ci} 8188c2ecf20Sopenharmony_ci 8198c2ecf20Sopenharmony_cistatic void intel_th_gth_remove(struct intel_th_device *thdev) 8208c2ecf20Sopenharmony_ci{ 8218c2ecf20Sopenharmony_ci struct gth_device *gth = dev_get_drvdata(&thdev->dev); 8228c2ecf20Sopenharmony_ci 8238c2ecf20Sopenharmony_ci sysfs_remove_group(>h->dev->kobj, >h->output_group); 8248c2ecf20Sopenharmony_ci sysfs_remove_group(>h->dev->kobj, >h->master_group); 8258c2ecf20Sopenharmony_ci} 8268c2ecf20Sopenharmony_ci 8278c2ecf20Sopenharmony_cistatic struct intel_th_driver intel_th_gth_driver = { 8288c2ecf20Sopenharmony_ci .probe = intel_th_gth_probe, 8298c2ecf20Sopenharmony_ci .remove = intel_th_gth_remove, 8308c2ecf20Sopenharmony_ci .assign = intel_th_gth_assign, 8318c2ecf20Sopenharmony_ci .unassign = intel_th_gth_unassign, 8328c2ecf20Sopenharmony_ci .set_output = intel_th_gth_set_output, 8338c2ecf20Sopenharmony_ci .prepare = intel_th_gth_prepare, 8348c2ecf20Sopenharmony_ci .enable = intel_th_gth_enable, 8358c2ecf20Sopenharmony_ci .trig_switch = intel_th_gth_switch, 8368c2ecf20Sopenharmony_ci .disable = intel_th_gth_disable, 8378c2ecf20Sopenharmony_ci .driver = { 8388c2ecf20Sopenharmony_ci .name = "gth", 8398c2ecf20Sopenharmony_ci .owner = THIS_MODULE, 8408c2ecf20Sopenharmony_ci }, 8418c2ecf20Sopenharmony_ci}; 8428c2ecf20Sopenharmony_ci 8438c2ecf20Sopenharmony_cimodule_driver(intel_th_gth_driver, 8448c2ecf20Sopenharmony_ci intel_th_driver_register, 8458c2ecf20Sopenharmony_ci intel_th_driver_unregister); 8468c2ecf20Sopenharmony_ci 8478c2ecf20Sopenharmony_ciMODULE_ALIAS("intel_th_switch"); 8488c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2"); 8498c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Intel(R) Trace Hub Global Trace Hub driver"); 8508c2ecf20Sopenharmony_ciMODULE_AUTHOR("Alexander Shishkin <alexander.shishkin@linux.intel.com>"); 851