dev.c 10.5 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
/*
 * Tegra host1x driver
 *
 * Copyright (c) 2010-2013, NVIDIA Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <linux/clk.h>
20
#include <linux/dma-mapping.h>
21 22 23 24 25 26
#include <linux/io.h>
#include <linux/list.h>
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/of.h>
#include <linux/slab.h>
27 28 29

#define CREATE_TRACE_POINTS
#include <trace/events/host1x.h>
30
#undef CREATE_TRACE_POINTS
31

32 33 34 35
#if IS_ENABLED(CONFIG_ARM_DMA_USE_IOMMU)
#include <asm/dma-iommu.h>
#endif

36
#include "bus.h"
37
#include "channel.h"
38
#include "debug.h"
39 40 41
#include "dev.h"
#include "intr.h"

42
#include "hw/host1x01.h"
43
#include "hw/host1x02.h"
44
#include "hw/host1x04.h"
45
#include "hw/host1x05.h"
46
#include "hw/host1x06.h"
47
#include "hw/host1x07.h"
48 49 50 51 52 53 54 55 56 57

void host1x_hypervisor_writel(struct host1x *host1x, u32 v, u32 r)
{
	writel(v, host1x->hv_regs + r);
}

u32 host1x_hypervisor_readl(struct host1x *host1x, u32 r)
{
	return readl(host1x->hv_regs + r);
}
58 59 60 61 62 63 64 65 66 67 68 69 70 71 72

void host1x_sync_writel(struct host1x *host1x, u32 v, u32 r)
{
	void __iomem *sync_regs = host1x->regs + host1x->info->sync_offset;

	writel(v, sync_regs + r);
}

u32 host1x_sync_readl(struct host1x *host1x, u32 r)
{
	void __iomem *sync_regs = host1x->regs + host1x->info->sync_offset;

	return readl(sync_regs + r);
}

73 74 75 76 77 78 79 80 81 82
void host1x_ch_writel(struct host1x_channel *ch, u32 v, u32 r)
{
	writel(v, ch->regs + r);
}

u32 host1x_ch_readl(struct host1x_channel *ch, u32 r)
{
	return readl(ch->regs + r);
}

83
static const struct host1x_info host1x01_info = {
84 85 86 87 88 89 90
	.nb_channels = 8,
	.nb_pts = 32,
	.nb_mlocks = 16,
	.nb_bases = 8,
	.init = host1x01_init,
	.sync_offset = 0x3000,
	.dma_mask = DMA_BIT_MASK(32),
91 92
};

93 94 95 96 97 98 99
static const struct host1x_info host1x02_info = {
	.nb_channels = 9,
	.nb_pts = 32,
	.nb_mlocks = 16,
	.nb_bases = 12,
	.init = host1x02_init,
	.sync_offset = 0x3000,
100
	.dma_mask = DMA_BIT_MASK(32),
101 102
};

103 104 105 106 107 108 109
static const struct host1x_info host1x04_info = {
	.nb_channels = 12,
	.nb_pts = 192,
	.nb_mlocks = 16,
	.nb_bases = 64,
	.init = host1x04_init,
	.sync_offset = 0x2100,
110
	.dma_mask = DMA_BIT_MASK(34),
111 112
};

113 114 115 116 117 118 119
static const struct host1x_info host1x05_info = {
	.nb_channels = 14,
	.nb_pts = 192,
	.nb_mlocks = 16,
	.nb_bases = 64,
	.init = host1x05_init,
	.sync_offset = 0x2100,
120
	.dma_mask = DMA_BIT_MASK(34),
121 122
};

123 124 125 126 127 128 129 130 131
static const struct host1x_sid_entry tegra186_sid_table[] = {
	{
		/* VIC */
		.base = 0x1af0,
		.offset = 0x30,
		.limit = 0x34
	},
};

132 133 134 135 136 137 138 139 140
static const struct host1x_info host1x06_info = {
	.nb_channels = 63,
	.nb_pts = 576,
	.nb_mlocks = 24,
	.nb_bases = 16,
	.init = host1x06_init,
	.sync_offset = 0x0,
	.dma_mask = DMA_BIT_MASK(34),
	.has_hypervisor = true,
141 142 143 144 145 146 147 148 149 150 151
	.num_sid_entries = ARRAY_SIZE(tegra186_sid_table),
	.sid_table = tegra186_sid_table,
};

static const struct host1x_sid_entry tegra194_sid_table[] = {
	{
		/* VIC */
		.base = 0x1af0,
		.offset = 0x30,
		.limit = 0x34
	},
152 153
};

154 155 156 157 158 159 160 161 162
static const struct host1x_info host1x07_info = {
	.nb_channels = 63,
	.nb_pts = 704,
	.nb_mlocks = 32,
	.nb_bases = 0,
	.init = host1x07_init,
	.sync_offset = 0x0,
	.dma_mask = DMA_BIT_MASK(40),
	.has_hypervisor = true,
163 164
	.num_sid_entries = ARRAY_SIZE(tegra194_sid_table),
	.sid_table = tegra194_sid_table,
165 166
};

167
static const struct of_device_id host1x_of_match[] = {
168
	{ .compatible = "nvidia,tegra194-host1x", .data = &host1x07_info, },
169
	{ .compatible = "nvidia,tegra186-host1x", .data = &host1x06_info, },
170
	{ .compatible = "nvidia,tegra210-host1x", .data = &host1x05_info, },
171
	{ .compatible = "nvidia,tegra124-host1x", .data = &host1x04_info, },
172
	{ .compatible = "nvidia,tegra114-host1x", .data = &host1x02_info, },
173 174 175 176 177 178
	{ .compatible = "nvidia,tegra30-host1x", .data = &host1x01_info, },
	{ .compatible = "nvidia,tegra20-host1x", .data = &host1x01_info, },
	{ },
};
MODULE_DEVICE_TABLE(of, host1x_of_match);

179 180 181 182 183 184 185 186 187 188 189 190 191
static void host1x_setup_sid_table(struct host1x *host)
{
	const struct host1x_info *info = host->info;
	unsigned int i;

	for (i = 0; i < info->num_sid_entries; i++) {
		const struct host1x_sid_entry *entry = &info->sid_table[i];

		host1x_hypervisor_writel(host, entry->offset, entry->base);
		host1x_hypervisor_writel(host, entry->limit, entry->base + 4);
	}
}

192 193 194
static int host1x_probe(struct platform_device *pdev)
{
	struct host1x *host;
195
	struct resource *regs, *hv_regs = NULL;
196 197 198
	int syncpt_irq;
	int err;

199 200 201
	host = devm_kzalloc(&pdev->dev, sizeof(*host), GFP_KERNEL);
	if (!host)
		return -ENOMEM;
202

203
	host->info = of_device_get_match_data(&pdev->dev);
204

205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
	if (host->info->has_hypervisor) {
		regs = platform_get_resource_byname(pdev, IORESOURCE_MEM, "vm");
		if (!regs) {
			dev_err(&pdev->dev, "failed to get vm registers\n");
			return -ENXIO;
		}

		hv_regs = platform_get_resource_byname(pdev, IORESOURCE_MEM,
						       "hypervisor");
		if (!hv_regs) {
			dev_err(&pdev->dev,
				"failed to get hypervisor registers\n");
			return -ENXIO;
		}
	} else {
		regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
		if (!regs) {
			dev_err(&pdev->dev, "failed to get registers\n");
			return -ENXIO;
		}
225 226 227 228
	}

	syncpt_irq = platform_get_irq(pdev, 0);
	if (syncpt_irq < 0) {
229 230
		dev_err(&pdev->dev, "failed to get IRQ: %d\n", syncpt_irq);
		return syncpt_irq;
231 232
	}

233 234 235
	mutex_init(&host->devices_lock);
	INIT_LIST_HEAD(&host->devices);
	INIT_LIST_HEAD(&host->list);
236 237 238 239 240 241 242 243 244
	host->dev = &pdev->dev;

	/* set common host1x device data */
	platform_set_drvdata(pdev, host);

	host->regs = devm_ioremap_resource(&pdev->dev, regs);
	if (IS_ERR(host->regs))
		return PTR_ERR(host->regs);

245 246 247 248 249 250
	if (host->info->has_hypervisor) {
		host->hv_regs = devm_ioremap_resource(&pdev->dev, hv_regs);
		if (IS_ERR(host->hv_regs))
			return PTR_ERR(host->hv_regs);
	}

251 252
	dma_set_mask_and_coherent(host->dev, host->info->dma_mask);

253 254 255 256 257 258 259 260 261 262 263 264 265
	if (host->info->init) {
		err = host->info->init(host);
		if (err)
			return err;
	}

	host->clk = devm_clk_get(&pdev->dev, NULL);
	if (IS_ERR(host->clk)) {
		dev_err(&pdev->dev, "failed to get clock\n");
		err = PTR_ERR(host->clk);
		return err;
	}

266 267
	host->rst = devm_reset_control_get(&pdev->dev, "host1x");
	if (IS_ERR(host->rst)) {
268
		err = PTR_ERR(host->rst);
269 270 271
		dev_err(&pdev->dev, "failed to get reset: %d\n", err);
		return err;
	}
272 273 274 275 276 277 278 279
#if IS_ENABLED(CONFIG_ARM_DMA_USE_IOMMU)
	if (host->dev->archdata.mapping) {
		struct dma_iommu_mapping *mapping =
				to_dma_iommu_mapping(host->dev);
		arm_iommu_detach_device(host->dev);
		arm_iommu_release_mapping(mapping);
	}
#endif
280 281 282
	if (IS_ENABLED(CONFIG_TEGRA_HOST1X_FIREWALL))
		goto skip_iommu;

283 284
	host->group = iommu_group_get(&pdev->dev);
	if (host->group) {
285 286 287
		struct iommu_domain_geometry *geometry;
		unsigned long order;

288 289 290 291
		err = iova_cache_get();
		if (err < 0)
			goto put_group;

292
		host->domain = iommu_domain_alloc(&platform_bus_type);
293 294
		if (!host->domain) {
			err = -ENOMEM;
295
			goto put_cache;
296
		}
297

298
		err = iommu_attach_group(host->domain, host->group);
299 300 301 302
		if (err) {
			if (err == -ENODEV) {
				iommu_domain_free(host->domain);
				host->domain = NULL;
303
				iova_cache_put();
304 305
				iommu_group_put(host->group);
				host->group = NULL;
306 307 308
				goto skip_iommu;
			}

309
			goto fail_free_domain;
310
		}
311 312 313 314 315

		geometry = &host->domain->geometry;

		order = __ffs(host->domain->pgsize_bitmap);
		init_iova_domain(&host->iova, 1UL << order,
316
				 geometry->aperture_start >> order);
317 318 319
		host->iova_end = geometry->aperture_end;
	}

320
skip_iommu:
321 322
	err = host1x_channel_list_init(&host->channel_list,
				       host->info->nb_channels);
323 324
	if (err) {
		dev_err(&pdev->dev, "failed to initialize channel list\n");
325
		goto fail_detach_device;
326 327
	}

328 329 330
	err = clk_prepare_enable(host->clk);
	if (err < 0) {
		dev_err(&pdev->dev, "failed to enable clock\n");
331
		goto fail_free_channels;
332 333
	}

334 335 336 337 338 339
	err = reset_control_deassert(host->rst);
	if (err < 0) {
		dev_err(&pdev->dev, "failed to deassert reset: %d\n", err);
		goto fail_unprepare_disable;
	}

340 341 342
	err = host1x_syncpt_init(host);
	if (err) {
		dev_err(&pdev->dev, "failed to initialize syncpts\n");
343
		goto fail_reset_assert;
344 345
	}

346 347 348 349 350 351
	err = host1x_intr_init(host, syncpt_irq);
	if (err) {
		dev_err(&pdev->dev, "failed to initialize interrupts\n");
		goto fail_deinit_syncpt;
	}

352 353
	host1x_debug_init(host);

354 355 356
	if (host->info->has_hypervisor)
		host1x_setup_sid_table(host);

357 358 359
	err = host1x_register(host);
	if (err < 0)
		goto fail_deinit_intr;
360

361
	return 0;
362

363 364
fail_deinit_intr:
	host1x_intr_deinit(host);
365 366
fail_deinit_syncpt:
	host1x_syncpt_deinit(host);
367 368
fail_reset_assert:
	reset_control_assert(host->rst);
369 370
fail_unprepare_disable:
	clk_disable_unprepare(host->clk);
371 372
fail_free_channels:
	host1x_channel_list_free(&host->channel_list);
373
fail_detach_device:
374
	if (host->group && host->domain) {
375
		put_iova_domain(&host->iova);
376
		iommu_detach_group(host->domain, host->group);
377 378 379 380
	}
fail_free_domain:
	if (host->domain)
		iommu_domain_free(host->domain);
381 382 383
put_cache:
	if (host->group)
		iova_cache_put();
384 385
put_group:
	iommu_group_put(host->group);
386

387
	return err;
388 389
}

390
static int host1x_remove(struct platform_device *pdev)
391 392 393
{
	struct host1x *host = platform_get_drvdata(pdev);

394
	host1x_unregister(host);
395
	host1x_intr_deinit(host);
396
	host1x_syncpt_deinit(host);
397
	reset_control_assert(host->rst);
398 399
	clk_disable_unprepare(host->clk);

400 401
	if (host->domain) {
		put_iova_domain(&host->iova);
402
		iommu_detach_group(host->domain, host->group);
403
		iommu_domain_free(host->domain);
404
		iova_cache_put();
405
		iommu_group_put(host->group);
406 407
	}

408 409 410
	return 0;
}

411
static struct platform_driver tegra_host1x_driver = {
412 413 414 415
	.driver = {
		.name = "tegra-host1x",
		.of_match_table = host1x_of_match,
	},
416 417
	.probe = host1x_probe,
	.remove = host1x_remove,
418 419
};

420 421 422 423 424
static struct platform_driver * const drivers[] = {
	&tegra_host1x_driver,
	&tegra_mipi_driver,
};

425 426 427 428
static int __init tegra_host1x_init(void)
{
	int err;

429
	err = bus_register(&host1x_bus_type);
430 431 432
	if (err < 0)
		return err;

433
	err = platform_register_drivers(drivers, ARRAY_SIZE(drivers));
434
	if (err < 0)
435
		bus_unregister(&host1x_bus_type);
436

437
	return err;
438 439 440 441 442
}
module_init(tegra_host1x_init);

static void __exit tegra_host1x_exit(void)
{
443
	platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
444
	bus_unregister(&host1x_bus_type);
445 446
}
module_exit(tegra_host1x_exit);
447

448
MODULE_AUTHOR("Thierry Reding <thierry.reding@avionic-design.de>");
449 450 451
MODULE_AUTHOR("Terje Bergstrom <tbergstrom@nvidia.com>");
MODULE_DESCRIPTION("Host1x driver for Tegra products");
MODULE_LICENSE("GPL");