hbmc-am654.c
2.2 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
// SPDX-License-Identifier: GPL-2.0
//
// Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/
// Author: Vignesh Raghavendra <vigneshr@ti.com>
#include <common.h>
#include <asm/io.h>
#include <dm.h>
#include <regmap.h>
#include <syscon.h>
#include <dm/device_compat.h>
#define FSS_SYSC_REG 0x4
#define HYPERBUS_CALIB_COUNT 25
struct am654_hbmc_priv {
void __iomem *mmiobase;
bool calibrated;
};
/* Calibrate by looking for "QRY" string within the CFI space */
static int am654_hyperbus_calibrate(struct udevice *dev)
{
struct am654_hbmc_priv *priv = dev_get_priv(dev);
int count = HYPERBUS_CALIB_COUNT;
int pass_count = 0;
u16 qry[3];
if (priv->calibrated)
return 0;
writew(0xF0, priv->mmiobase);
writew(0x98, priv->mmiobase + 0xaa);
while (count--) {
qry[0] = readw(priv->mmiobase + 0x20);
qry[1] = readw(priv->mmiobase + 0x22);
qry[2] = readw(priv->mmiobase + 0x24);
if (qry[0] == 'Q' && qry[1] == 'R' && qry[2] == 'Y')
pass_count++;
else
pass_count = 0;
if (pass_count == 5)
break;
}
writew(0xF0, priv->mmiobase);
writew(0xFF, priv->mmiobase);
return pass_count == 5;
}
static int am654_select_hbmc(struct udevice *dev)
{
struct regmap *regmap = syscon_get_regmap(dev_get_parent(dev));
return regmap_update_bits(regmap, FSS_SYSC_REG, 0x2, 0x2);
}
static int am654_hbmc_bind(struct udevice *dev)
{
return dm_scan_fdt_dev(dev);
}
static int am654_hbmc_probe(struct udevice *dev)
{
struct am654_hbmc_priv *priv = dev_get_priv(dev);
int ret;
priv->mmiobase = devfdt_remap_addr_index(dev, 1);
if (dev_read_bool(dev, "mux-controls")) {
ret = am654_select_hbmc(dev);
if (ret) {
dev_err(dev, "Failed to select HBMC mux\n");
return ret;
}
}
if (!priv->calibrated) {
ret = am654_hyperbus_calibrate(dev);
if (!ret) {
dev_err(dev, "Calibration Failed\n");
return -EIO;
}
}
priv->calibrated = true;
return 0;
}
static const struct udevice_id am654_hbmc_dt_ids[] = {
{
.compatible = "ti,am654-hbmc",
},
{ /* end of table */ }
};
U_BOOT_DRIVER(hbmc_am654) = {
.name = "hbmc-am654",
.id = UCLASS_MTD,
.of_match = am654_hbmc_dt_ids,
.probe = am654_hbmc_probe,
.bind = am654_hbmc_bind,
.priv_auto_alloc_size = sizeof(struct am654_hbmc_priv),
};