forked from ~ljy/RK356X_SDK_RELEASE

hc
2024-01-31 f70575805708cabdedea7498aaa3f710fde4d920
kernel/drivers/soc/rockchip/rockchip_thunderboot_service.c
....@@ -24,6 +24,7 @@
2424 struct reset_control *rsts;
2525 phys_addr_t mem_start;
2626 size_t mem_size;
27
+ bool mem_no_free;
2728 };
2829
2930 static atomic_t mcu_done = ATOMIC_INIT(0);
....@@ -76,7 +77,7 @@
7677
7778 static void do_mcu_done(struct rk_tb_serv *serv)
7879 {
79
- struct rk_tb_client *client, *client_s;
80
+ struct rk_tb_client *client;
8081 struct rockchip_mbox_msg msg;
8182
8283 rockchip_mbox_read_msg(serv->mbox_rx_chan, &msg);
....@@ -89,7 +90,8 @@
8990
9091 start = phys_to_virt(serv->mem_start);
9192 end = start + serv->mem_size;
92
- free_reserved_area(start, end, -1, "rtos");
93
+ if (!serv->mem_no_free)
94
+ free_reserved_area(start, end, -1, "rtos");
9395
9496 spin_lock(&lock);
9597 if (atomic_read(&mcu_done)) {
....@@ -97,12 +99,13 @@
9799 return;
98100 }
99101
100
- list_for_each_entry_safe(client, client_s, &clients_list, node) {
102
+ while (!list_empty(&clients_list)) {
103
+ client = list_first_entry(&clients_list, struct rk_tb_client, node);
104
+ list_del(&client->node);
101105 spin_unlock(&lock);
102106 if (client->cb)
103107 client->cb(client->data);
104108 spin_lock(&lock);
105
- list_del(&client->node);
106109 }
107110 atomic_set(&mcu_done, 1);
108111 spin_unlock(&lock);
....@@ -149,6 +152,8 @@
149152 if (IS_ERR(serv->rsts) && PTR_ERR(serv->rsts) == -EPROBE_DEFER)
150153 return -EPROBE_DEFER;
151154
155
+ serv->mem_no_free = device_property_read_bool(&pdev->dev, "memory-no-free");
156
+
152157 platform_set_drvdata(pdev, serv);
153158
154159 mbox_cl = &serv->mbox_cl;