57 bool uwb_rsv_has_two_drp_ies(struct uwb_rsv *rsv)  in uwb_rsv_has_two_drp_ies()  argument
79 	return has_two_drp_ies[rsv->state];  in uwb_rsv_has_two_drp_ies()
106 void uwb_rsv_dump(char *text, struct uwb_rsv *rsv)  in uwb_rsv_dump()  argument
108 	struct device *dev = &rsv->rc->uwb_dev.dev;  in uwb_rsv_dump()
112 	uwb_dev_addr_print(owner, sizeof(owner), &rsv->owner->dev_addr);  in uwb_rsv_dump()
113 	if (rsv->target.type == UWB_RSV_TARGET_DEV)  in uwb_rsv_dump()
114 		devaddr = rsv->target.dev->dev_addr;  in uwb_rsv_dump()
116 		devaddr = rsv->target.devaddr;  in uwb_rsv_dump()
120 		text, owner, target, uwb_rsv_state_str(rsv->state));  in uwb_rsv_dump()
125 	struct uwb_rsv *rsv = container_of(kref, struct uwb_rsv, kref);  in uwb_rsv_release()  local
127 	kfree(rsv);  in uwb_rsv_release()
130 void uwb_rsv_get(struct uwb_rsv *rsv)  in uwb_rsv_get()  argument
132 	kref_get(&rsv->kref);  in uwb_rsv_get()
135 void uwb_rsv_put(struct uwb_rsv *rsv)  in uwb_rsv_put()  argument
137 	kref_put(&rsv->kref, uwb_rsv_release);  in uwb_rsv_put()
147 static int uwb_rsv_get_stream(struct uwb_rsv *rsv)  in uwb_rsv_get_stream()  argument
149 	struct uwb_rc *rc = rsv->rc;  in uwb_rsv_get_stream()
154 	switch (rsv->target.type) {  in uwb_rsv_get_stream()
156 		streams_bm = rsv->target.dev->streams;  in uwb_rsv_get_stream()
171 	rsv->stream = stream;  in uwb_rsv_get_stream()
174 	dev_dbg(dev, "get stream %d\n", rsv->stream);  in uwb_rsv_get_stream()
179 static void uwb_rsv_put_stream(struct uwb_rsv *rsv)  in uwb_rsv_put_stream()  argument
181 	struct uwb_rc *rc = rsv->rc;  in uwb_rsv_put_stream()
185 	switch (rsv->target.type) {  in uwb_rsv_put_stream()
187 		streams_bm = rsv->target.dev->streams;  in uwb_rsv_put_stream()
196 	clear_bit(rsv->stream, streams_bm);  in uwb_rsv_put_stream()
198 	dev_dbg(dev, "put stream %d\n", rsv->stream);  in uwb_rsv_put_stream()
245 static void uwb_rsv_stroke_timer(struct uwb_rsv *rsv)  in uwb_rsv_stroke_timer()  argument
254 	if (rsv->state == UWB_RSV_STATE_NONE) {  in uwb_rsv_stroke_timer()
256 	} else if (rsv->is_multicast) {  in uwb_rsv_stroke_timer()
257 		if (rsv->state == UWB_RSV_STATE_O_INITIATED  in uwb_rsv_stroke_timer()
258 		    || rsv->state == UWB_RSV_STATE_O_MOVE_EXPANDING  in uwb_rsv_stroke_timer()
259 		    || rsv->state == UWB_RSV_STATE_O_MOVE_COMBINING  in uwb_rsv_stroke_timer()
260 		    || rsv->state == UWB_RSV_STATE_O_MOVE_REDUCING)  in uwb_rsv_stroke_timer()
262 		if (rsv->state == UWB_RSV_STATE_O_ESTABLISHED)  in uwb_rsv_stroke_timer()
273 		mod_timer(&rsv->timer, jiffies + usecs_to_jiffies(timeout_us));  in uwb_rsv_stroke_timer()
275 		del_timer(&rsv->timer);  in uwb_rsv_stroke_timer()
282 static void uwb_rsv_state_update(struct uwb_rsv *rsv,  in uwb_rsv_state_update()  argument
285 	rsv->state = new_state;  in uwb_rsv_state_update()
286 	rsv->ie_valid = false;  in uwb_rsv_state_update()
288 	uwb_rsv_dump("SU", rsv);  in uwb_rsv_state_update()
290 	uwb_rsv_stroke_timer(rsv);  in uwb_rsv_state_update()
291 	uwb_rsv_sched_update(rsv->rc);  in uwb_rsv_state_update()
294 static void uwb_rsv_callback(struct uwb_rsv *rsv)  in uwb_rsv_callback()  argument
296 	if (rsv->callback)  in uwb_rsv_callback()
297 		rsv->callback(rsv);  in uwb_rsv_callback()
300 void uwb_rsv_set_state(struct uwb_rsv *rsv, enum uwb_rsv_state new_state)  in uwb_rsv_set_state()  argument
302 	struct uwb_rsv_move *mv = &rsv->mv;  in uwb_rsv_set_state()
304 	if (rsv->state == new_state) {  in uwb_rsv_set_state()
305 		switch (rsv->state) {  in uwb_rsv_set_state()
314 			uwb_rsv_stroke_timer(rsv);  in uwb_rsv_set_state()
324 	uwb_rsv_dump("SC", rsv);  in uwb_rsv_set_state()
328 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_NONE);  in uwb_rsv_set_state()
329 		uwb_rsv_remove(rsv);  in uwb_rsv_set_state()
330 		uwb_rsv_callback(rsv);  in uwb_rsv_set_state()
333 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_INITIATED);  in uwb_rsv_set_state()
336 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_PENDING);  in uwb_rsv_set_state()
340 		bitmap_andnot(rsv->mas.bm, rsv->mas.bm, mv->companion_mas.bm, UWB_NUM_MAS);  in uwb_rsv_set_state()
341 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_MODIFIED);  in uwb_rsv_set_state()
344 		if (rsv->state == UWB_RSV_STATE_O_MODIFIED  in uwb_rsv_set_state()
345 		    || rsv->state == UWB_RSV_STATE_O_MOVE_REDUCING) {  in uwb_rsv_set_state()
346 			uwb_drp_avail_release(rsv->rc, &mv->companion_mas);  in uwb_rsv_set_state()
347 			rsv->needs_release_companion_mas = false;  in uwb_rsv_set_state()
349 		uwb_drp_avail_reserve(rsv->rc, &rsv->mas);  in uwb_rsv_set_state()
350 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_ESTABLISHED);  in uwb_rsv_set_state()
351 		uwb_rsv_callback(rsv);  in uwb_rsv_set_state()
354 		rsv->needs_release_companion_mas = true;  in uwb_rsv_set_state()
355 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_MOVE_EXPANDING);  in uwb_rsv_set_state()
358 		rsv->needs_release_companion_mas = false;  in uwb_rsv_set_state()
359 		uwb_drp_avail_reserve(rsv->rc, &mv->companion_mas);  in uwb_rsv_set_state()
360 		bitmap_or(rsv->mas.bm, rsv->mas.bm, mv->companion_mas.bm, UWB_NUM_MAS);  in uwb_rsv_set_state()
361 		rsv->mas.safe   += mv->companion_mas.safe;  in uwb_rsv_set_state()
362 		rsv->mas.unsafe += mv->companion_mas.unsafe;  in uwb_rsv_set_state()
363 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_MOVE_COMBINING);  in uwb_rsv_set_state()
366 		bitmap_andnot(mv->companion_mas.bm, rsv->mas.bm, mv->final_mas.bm, UWB_NUM_MAS);  in uwb_rsv_set_state()
367 		rsv->needs_release_companion_mas = true;  in uwb_rsv_set_state()
368 		rsv->mas.safe   = mv->final_mas.safe;  in uwb_rsv_set_state()
369 		rsv->mas.unsafe = mv->final_mas.unsafe;  in uwb_rsv_set_state()
370 		bitmap_copy(rsv->mas.bm, mv->final_mas.bm, UWB_NUM_MAS);  in uwb_rsv_set_state()
371 		bitmap_copy(rsv->mas.unsafe_bm, mv->final_mas.unsafe_bm, UWB_NUM_MAS);  in uwb_rsv_set_state()
372 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_O_MOVE_REDUCING);  in uwb_rsv_set_state()
376 		rsv->needs_release_companion_mas = false;  in uwb_rsv_set_state()
377 		uwb_drp_avail_reserve(rsv->rc, &rsv->mas);  in uwb_rsv_set_state()
378 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_T_ACCEPTED);  in uwb_rsv_set_state()
379 		uwb_rsv_callback(rsv);  in uwb_rsv_set_state()
382 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_T_DENIED);  in uwb_rsv_set_state()
385 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_T_CONFLICT);  in uwb_rsv_set_state()
388 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_T_PENDING);  in uwb_rsv_set_state()
391 		rsv->needs_release_companion_mas = true;  in uwb_rsv_set_state()
392 		uwb_drp_avail_reserve(rsv->rc, &mv->companion_mas);  in uwb_rsv_set_state()
393 		uwb_rsv_state_update(rsv, UWB_RSV_STATE_T_EXPANDING_ACCEPTED);  in uwb_rsv_set_state()
396 		dev_err(&rsv->rc->uwb_dev.dev, "unhandled state: %s (%d)\n",  in uwb_rsv_set_state()
403 	struct uwb_rsv *rsv = container_of(work, struct uwb_rsv,  in uwb_rsv_handle_timeout_work()  local
405 	struct uwb_rc *rc = rsv->rc;  in uwb_rsv_handle_timeout_work()
409 	uwb_rsv_dump("TO", rsv);  in uwb_rsv_handle_timeout_work()
411 	switch (rsv->state) {  in uwb_rsv_handle_timeout_work()
413 		if (rsv->is_multicast) {  in uwb_rsv_handle_timeout_work()
414 			uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_ESTABLISHED);  in uwb_rsv_handle_timeout_work()
419 		if (rsv->is_multicast) {  in uwb_rsv_handle_timeout_work()
420 			uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_MOVE_COMBINING);  in uwb_rsv_handle_timeout_work()
425 		if (rsv->is_multicast) {  in uwb_rsv_handle_timeout_work()
426 			uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_MOVE_REDUCING);  in uwb_rsv_handle_timeout_work()
431 		if (rsv->is_multicast) {  in uwb_rsv_handle_timeout_work()
432 			uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_ESTABLISHED);  in uwb_rsv_handle_timeout_work()
437 		if (rsv->is_multicast)  in uwb_rsv_handle_timeout_work()
447 		uwb_rsv_set_state(rsv, UWB_RSV_STATE_T_ACCEPTED);  in uwb_rsv_handle_timeout_work()
448 		uwb_drp_avail_release(rsv->rc, &rsv->mv.companion_mas);  in uwb_rsv_handle_timeout_work()
456 	uwb_rsv_remove(rsv);  in uwb_rsv_handle_timeout_work()
464 	struct uwb_rsv *rsv;  in uwb_rsv_alloc()  local
466 	rsv = kzalloc(sizeof(struct uwb_rsv), GFP_KERNEL);  in uwb_rsv_alloc()
467 	if (!rsv)  in uwb_rsv_alloc()
470 	INIT_LIST_HEAD(&rsv->rc_node);  in uwb_rsv_alloc()
471 	INIT_LIST_HEAD(&rsv->pal_node);  in uwb_rsv_alloc()
472 	kref_init(&rsv->kref);  in uwb_rsv_alloc()
473 	init_timer(&rsv->timer);  in uwb_rsv_alloc()
474 	rsv->timer.function = uwb_rsv_timer;  in uwb_rsv_alloc()
475 	rsv->timer.data     = (unsigned long)rsv;  in uwb_rsv_alloc()
477 	rsv->rc = rc;  in uwb_rsv_alloc()
478 	INIT_WORK(&rsv->handle_timeout_work, uwb_rsv_handle_timeout_work);  in uwb_rsv_alloc()
480 	return rsv;  in uwb_rsv_alloc()
498 	struct uwb_rsv *rsv;  in uwb_rsv_create()  local
500 	rsv = uwb_rsv_alloc(rc);  in uwb_rsv_create()
501 	if (!rsv)  in uwb_rsv_create()
504 	rsv->callback = cb;  in uwb_rsv_create()
505 	rsv->pal_priv = pal_priv;  in uwb_rsv_create()
507 	return rsv;  in uwb_rsv_create()
511 void uwb_rsv_remove(struct uwb_rsv *rsv)  in uwb_rsv_remove()  argument
513 	uwb_rsv_dump("RM", rsv);  in uwb_rsv_remove()
515 	if (rsv->state != UWB_RSV_STATE_NONE)  in uwb_rsv_remove()
516 		uwb_rsv_set_state(rsv, UWB_RSV_STATE_NONE);  in uwb_rsv_remove()
518 	if (rsv->needs_release_companion_mas)  in uwb_rsv_remove()
519 		uwb_drp_avail_release(rsv->rc, &rsv->mv.companion_mas);  in uwb_rsv_remove()
520 	uwb_drp_avail_release(rsv->rc, &rsv->mas);  in uwb_rsv_remove()
522 	if (uwb_rsv_is_owner(rsv))  in uwb_rsv_remove()
523 		uwb_rsv_put_stream(rsv);  in uwb_rsv_remove()
525 	uwb_dev_put(rsv->owner);  in uwb_rsv_remove()
526 	if (rsv->target.type == UWB_RSV_TARGET_DEV)  in uwb_rsv_remove()
527 		uwb_dev_put(rsv->target.dev);  in uwb_rsv_remove()
529 	list_del_init(&rsv->rc_node);  in uwb_rsv_remove()
530 	uwb_rsv_put(rsv);  in uwb_rsv_remove()
539 void uwb_rsv_destroy(struct uwb_rsv *rsv)  in uwb_rsv_destroy()  argument
541 	uwb_rsv_put(rsv);  in uwb_rsv_destroy()
556 int uwb_rsv_establish(struct uwb_rsv *rsv)  in uwb_rsv_establish()  argument
558 	struct uwb_rc *rc = rsv->rc;  in uwb_rsv_establish()
564 	ret = uwb_rsv_get_stream(rsv);  in uwb_rsv_establish()
571 	rsv->tiebreaker = prandom_u32() & 1;  in uwb_rsv_establish()
575 	ret = uwb_rsv_find_best_allocation(rsv, &available, &rsv->mas);  in uwb_rsv_establish()
578 		uwb_rsv_put_stream(rsv);  in uwb_rsv_establish()
584 	ret = uwb_drp_avail_reserve_pending(rc, &rsv->mas);  in uwb_rsv_establish()
586 		uwb_rsv_put_stream(rsv);  in uwb_rsv_establish()
592 	uwb_rsv_get(rsv);  in uwb_rsv_establish()
593 	list_add_tail(&rsv->rc_node, &rc->reservations);  in uwb_rsv_establish()
594 	rsv->owner = &rc->uwb_dev;  in uwb_rsv_establish()
595 	uwb_dev_get(rsv->owner);  in uwb_rsv_establish()
596 	uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_INITIATED);  in uwb_rsv_establish()
612 int uwb_rsv_modify(struct uwb_rsv *rsv, int max_mas, int min_mas, int max_interval)  in uwb_rsv_modify()  argument
622 int uwb_rsv_try_move(struct uwb_rsv *rsv, struct uwb_mas_bm *available)  in uwb_rsv_try_move()  argument
624 	struct uwb_rc *rc = rsv->rc;  in uwb_rsv_try_move()
633 	mv = &rsv->mv;  in uwb_rsv_try_move()
635 	if (uwb_rsv_find_best_allocation(rsv, available, &mv->final_mas) == UWB_RSV_ALLOC_FOUND) {  in uwb_rsv_try_move()
637 		if (!bitmap_equal(rsv->mas.bm, mv->final_mas.bm, UWB_NUM_MAS)) {  in uwb_rsv_try_move()
639 			bitmap_andnot(mv->companion_mas.bm, mv->final_mas.bm, rsv->mas.bm, UWB_NUM_MAS);  in uwb_rsv_try_move()
641 			uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_MOVE_EXPANDING);  in uwb_rsv_try_move()
656 	struct uwb_rsv *rsv;  in uwb_rsv_handle_drp_avail_change()  local
662 	list_for_each_entry(rsv, &rc->reservations, rc_node) {  in uwb_rsv_handle_drp_avail_change()
663 		if (rsv->state == UWB_RSV_STATE_O_ESTABLISHED ||  in uwb_rsv_handle_drp_avail_change()
664 		    rsv->state == UWB_RSV_STATE_O_TO_BE_MOVED) {  in uwb_rsv_handle_drp_avail_change()
666 			bitmap_or(mas.bm, mas.bm, rsv->mas.bm, UWB_NUM_MAS);  in uwb_rsv_handle_drp_avail_change()
667 			uwb_rsv_try_move(rsv, &mas);  in uwb_rsv_handle_drp_avail_change()
683 void uwb_rsv_terminate(struct uwb_rsv *rsv)  in uwb_rsv_terminate()  argument
685 	struct uwb_rc *rc = rsv->rc;  in uwb_rsv_terminate()
689 	if (rsv->state != UWB_RSV_STATE_NONE)  in uwb_rsv_terminate()
690 		uwb_rsv_set_state(rsv, UWB_RSV_STATE_NONE);  in uwb_rsv_terminate()
708 void uwb_rsv_accept(struct uwb_rsv *rsv, uwb_rsv_cb_f cb, void *pal_priv)  in uwb_rsv_accept()  argument
710 	uwb_rsv_get(rsv);  in uwb_rsv_accept()
712 	rsv->callback = cb;  in uwb_rsv_accept()
713 	rsv->pal_priv = pal_priv;  in uwb_rsv_accept()
714 	rsv->state    = UWB_RSV_STATE_T_ACCEPTED;  in uwb_rsv_accept()
721 static bool uwb_rsv_match(struct uwb_rsv *rsv, struct uwb_dev *src,  in uwb_rsv_match()  argument
729 	if (rsv->stream != stream)  in uwb_rsv_match()
732 	switch (rsv->target.type) {  in uwb_rsv_match()
734 		return rsv->stream == stream;  in uwb_rsv_match()
737 			rsv_src = &rsv->owner->dev_addr;  in uwb_rsv_match()
739 			rsv_src = &rsv->target.dev->dev_addr;  in uwb_rsv_match()
749 	struct uwb_rsv *rsv;  in uwb_rsv_new_target()  local
753 	rsv = uwb_rsv_alloc(rc);  in uwb_rsv_new_target()
754 	if (!rsv)  in uwb_rsv_new_target()
757 	rsv->rc          = rc;  in uwb_rsv_new_target()
758 	rsv->owner       = src;  in uwb_rsv_new_target()
759 	uwb_dev_get(rsv->owner);  in uwb_rsv_new_target()
760 	rsv->target.type = UWB_RSV_TARGET_DEV;  in uwb_rsv_new_target()
761 	rsv->target.dev  = &rc->uwb_dev;  in uwb_rsv_new_target()
763 	rsv->type        = uwb_ie_drp_type(drp_ie);  in uwb_rsv_new_target()
764 	rsv->stream      = uwb_ie_drp_stream_index(drp_ie);  in uwb_rsv_new_target()
765 	uwb_drp_ie_to_bm(&rsv->mas, drp_ie);  in uwb_rsv_new_target()
771 	rsv->state = UWB_RSV_STATE_T_DENIED;  in uwb_rsv_new_target()
775 			pal->new_rsv(pal, rsv);  in uwb_rsv_new_target()
776 		if (rsv->state == UWB_RSV_STATE_T_ACCEPTED)  in uwb_rsv_new_target()
781 	list_add_tail(&rsv->rc_node, &rc->reservations);  in uwb_rsv_new_target()
782 	state = rsv->state;  in uwb_rsv_new_target()
783 	rsv->state = UWB_RSV_STATE_NONE;  in uwb_rsv_new_target()
787 	    && uwb_drp_avail_reserve_pending(rc, &rsv->mas) == -EBUSY) {  in uwb_rsv_new_target()
790 		uwb_rsv_set_state(rsv, state);  in uwb_rsv_new_target()
793 	return rsv;  in uwb_rsv_new_target()
804 void uwb_rsv_get_usable_mas(struct uwb_rsv *rsv, struct uwb_mas_bm *mas)  in uwb_rsv_get_usable_mas()  argument
807 	bitmap_andnot(mas->bm, rsv->mas.bm, rsv->rc->cnflt_alien_bitmap.bm, UWB_NUM_MAS);  in uwb_rsv_get_usable_mas()
824 	struct uwb_rsv *rsv;  in uwb_rsv_find()  local
826 	list_for_each_entry(rsv, &rc->reservations, rc_node) {  in uwb_rsv_find()
827 		if (uwb_rsv_match(rsv, src, drp_ie))  in uwb_rsv_find()
828 			return rsv;  in uwb_rsv_find()
846 	struct uwb_rsv *rsv, *t;  in uwb_rsv_update_all()  local
849 	list_for_each_entry_safe(rsv, t, &rc->reservations, rc_node) {  in uwb_rsv_update_all()
850 		if (!rsv->ie_valid) {  in uwb_rsv_update_all()
851 			uwb_drp_ie_update(rsv);  in uwb_rsv_update_all()
931 	struct uwb_rsv *rsv;  in uwb_rsv_alien_bp_work()  local
935 	list_for_each_entry(rsv, &rc->reservations, rc_node) {  in uwb_rsv_alien_bp_work()
936 		if (rsv->type != UWB_DRP_TYPE_ALIEN_BP) {  in uwb_rsv_alien_bp_work()
937 			uwb_rsv_callback(rsv);  in uwb_rsv_alien_bp_work()
946 	struct uwb_rsv *rsv = (struct uwb_rsv *)arg;  in uwb_rsv_timer()  local
948 	queue_work(rsv->rc->rsv_workq, &rsv->handle_timeout_work);  in uwb_rsv_timer()
959 	struct uwb_rsv *rsv, *t;  in uwb_rsv_remove_all()  local
962 	list_for_each_entry_safe(rsv, t, &rc->reservations, rc_node) {  in uwb_rsv_remove_all()
963 		if (rsv->state != UWB_RSV_STATE_NONE)  in uwb_rsv_remove_all()
964 			uwb_rsv_set_state(rsv, UWB_RSV_STATE_NONE);  in uwb_rsv_remove_all()
965 		del_timer_sync(&rsv->timer);  in uwb_rsv_remove_all()
975 	list_for_each_entry_safe(rsv, t, &rc->reservations, rc_node) {  in uwb_rsv_remove_all()
976 		uwb_rsv_remove(rsv);  in uwb_rsv_remove_all()