add wifi6 8852be driver

hc

2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da

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
// SPDX-License-Identifier: GPL-2.0
#include <linux/slab.h>
#include <linux/io.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/reset-controller.h>
 
#include "reset.h"
 
#define rcdev_to_unit(rcdev) container_of(rcdev, struct mmp_clk_reset_unit, rcdev)
 
static int mmp_of_reset_xlate(struct reset_controller_dev *rcdev,
              const struct of_phandle_args *reset_spec)
{
    struct mmp_clk_reset_unit *unit = rcdev_to_unit(rcdev);
    struct mmp_clk_reset_cell *cell;
    int i;
 
    if (WARN_ON(reset_spec->args_count != rcdev->of_reset_n_cells))
        return -EINVAL;
 
    for (i = 0; i < rcdev->nr_resets; i++) {
        cell = &unit->cells[i];
        if (cell->clk_id == reset_spec->args[0])
            break;
    }
 
    if (i == rcdev->nr_resets)
        return -EINVAL;
 
    return i;
}
 
static int mmp_clk_reset_assert(struct reset_controller_dev *rcdev,
                unsigned long id)
{
    struct mmp_clk_reset_unit *unit = rcdev_to_unit(rcdev);
    struct mmp_clk_reset_cell *cell;
    unsigned long flags = 0;
    u32 val;
 
    cell = &unit->cells[id];
    if (cell->lock)
        spin_lock_irqsave(cell->lock, flags);
 
    val = readl(cell->reg);
    val |= cell->bits;
    writel(val, cell->reg);
 
    if (cell->lock)
        spin_unlock_irqrestore(cell->lock, flags);
 
    return 0;
}
 
static int mmp_clk_reset_deassert(struct reset_controller_dev *rcdev,
                unsigned long id)
{
    struct mmp_clk_reset_unit *unit = rcdev_to_unit(rcdev);
    struct mmp_clk_reset_cell *cell;
    unsigned long flags = 0;
    u32 val;
 
    cell = &unit->cells[id];
    if (cell->lock)
        spin_lock_irqsave(cell->lock, flags);
 
    val = readl(cell->reg);
    val &= ~cell->bits;
    writel(val, cell->reg);
 
    if (cell->lock)
        spin_unlock_irqrestore(cell->lock, flags);
 
    return 0;
}
 
static const struct reset_control_ops mmp_clk_reset_ops = {
    .assert        = mmp_clk_reset_assert,
    .deassert    = mmp_clk_reset_deassert,
};
 
void mmp_clk_reset_register(struct device_node *np,
            struct mmp_clk_reset_cell *cells, int nr_resets)
{
    struct mmp_clk_reset_unit *unit;
 
    unit = kzalloc(sizeof(*unit), GFP_KERNEL);
    if (!unit)
        return;
 
    unit->cells = cells;
    unit->rcdev.of_reset_n_cells = 1;
    unit->rcdev.nr_resets = nr_resets;
    unit->rcdev.ops = &mmp_clk_reset_ops;
    unit->rcdev.of_node = np;
    unit->rcdev.of_xlate = mmp_of_reset_xlate;
 
    reset_controller_register(&unit->rcdev);
}