38 #define DUMP_ID_CPU(cpu, id) pr_debug("%s called;  cpu=%d, id=%d\n", __func__, cpu, id)  argument
39 #define DUMP_ID(id)   pr_debug("%s called; id=%d\n", __func__, id)  argument
43 #define DUMP_ID(id)  argument
44 #define DUMP_ID_CPU(cpu, id)  argument
85 	int id = 0;  in coresight_trace_id_alloc_new_id()  local
90 		id = preferred_id;  in coresight_trace_id_alloc_new_id()
94 		id = coresight_trace_id_find_odd_id(id_map);  in coresight_trace_id_alloc_new_id()
95 		if (id)  in coresight_trace_id_alloc_new_id()
103 	id = find_next_zero_bit(id_map->used_ids, CORESIGHT_TRACE_ID_RES_TOP, 1);  in coresight_trace_id_alloc_new_id()
104 	if (id >= CORESIGHT_TRACE_ID_RES_TOP)  in coresight_trace_id_alloc_new_id()
109 	set_bit(id, id_map->used_ids);  in coresight_trace_id_alloc_new_id()
110 	return id;  in coresight_trace_id_alloc_new_id()
113 static void coresight_trace_id_free(int id, struct coresight_trace_id_map *id_map)  in coresight_trace_id_free()  argument
115 	if (WARN(!IS_VALID_CS_TRACE_ID(id), "Invalid Trace ID %d\n", id))  in coresight_trace_id_free()
117 	if (WARN(!test_bit(id, id_map->used_ids), "Freeing unused ID %d\n", id))  in coresight_trace_id_free()
119 	clear_bit(id, id_map->used_ids);  in coresight_trace_id_free()
122 static void coresight_trace_id_set_pend_rel(int id, struct coresight_trace_id_map *id_map)  in coresight_trace_id_set_pend_rel()  argument
124 	if (WARN(!IS_VALID_CS_TRACE_ID(id), "Invalid Trace ID %d\n", id))  in coresight_trace_id_set_pend_rel()
126 	set_bit(id, id_map->pend_rel_ids);  in coresight_trace_id_set_pend_rel()
157 	int id;  in coresight_trace_id_map_get_cpu_id()  local
162 	id = _coresight_trace_id_read_cpu_id(cpu);  in coresight_trace_id_map_get_cpu_id()
163 	if (id)  in coresight_trace_id_map_get_cpu_id()
176 	id = coresight_trace_id_alloc_new_id(id_map,  in coresight_trace_id_map_get_cpu_id()
179 	if (!IS_VALID_CS_TRACE_ID(id))  in coresight_trace_id_map_get_cpu_id()
183 	atomic_set(&per_cpu(cpu_id, cpu), id);  in coresight_trace_id_map_get_cpu_id()
188 	clear_bit(id, id_map->pend_rel_ids);  in coresight_trace_id_map_get_cpu_id()
193 	DUMP_ID_CPU(cpu, id);  in coresight_trace_id_map_get_cpu_id()
195 	return id;  in coresight_trace_id_map_get_cpu_id()
201 	int id;  in coresight_trace_id_map_put_cpu_id()  local
204 	id = _coresight_trace_id_read_cpu_id(cpu);  in coresight_trace_id_map_put_cpu_id()
205 	if (!id)  in coresight_trace_id_map_put_cpu_id()
212 		coresight_trace_id_set_pend_rel(id, id_map);  in coresight_trace_id_map_put_cpu_id()
216 		coresight_trace_id_free(id, id_map);  in coresight_trace_id_map_put_cpu_id()
221 	DUMP_ID_CPU(cpu, id);  in coresight_trace_id_map_put_cpu_id()
228 	int id;  in coresight_trace_id_map_get_system_id()  local
232 	id = coresight_trace_id_alloc_new_id(id_map, 0, true);  in coresight_trace_id_map_get_system_id()
235 	DUMP_ID(id);  in coresight_trace_id_map_get_system_id()
237 	return id;  in coresight_trace_id_map_get_system_id()
240 static void coresight_trace_id_map_put_system_id(struct coresight_trace_id_map *id_map, int id)  in coresight_trace_id_map_put_system_id()  argument
245 	coresight_trace_id_free(id, id_map);  in coresight_trace_id_map_put_system_id()
248 	DUMP_ID(id);  in coresight_trace_id_map_put_system_id()
278 void coresight_trace_id_put_system_id(int id)  in coresight_trace_id_put_system_id()  argument
280 	coresight_trace_id_map_put_system_id(&id_map_default, id);  in coresight_trace_id_put_system_id()