88 static void hil_mlc_clear_di_map(hil_mlc *mlc, int val)  in hil_mlc_clear_di_map()  argument
93 		mlc->di_map[j] = -1;  in hil_mlc_clear_di_map()
96 static void hil_mlc_clear_di_scratch(hil_mlc *mlc)  in hil_mlc_clear_di_scratch()  argument
98 	memset(&mlc->di_scratch, 0, sizeof(mlc->di_scratch));  in hil_mlc_clear_di_scratch()
101 static void hil_mlc_copy_di_scratch(hil_mlc *mlc, int idx)  in hil_mlc_copy_di_scratch()  argument
103 	memcpy(&mlc->di[idx], &mlc->di_scratch, sizeof(mlc->di_scratch));  in hil_mlc_copy_di_scratch()
106 static int hil_mlc_match_di_scratch(hil_mlc *mlc)  in hil_mlc_match_di_scratch()  argument
115 			if (mlc->di_map[j] == idx)  in hil_mlc_match_di_scratch()
121 		if (!memcmp(mlc->di + idx, &mlc->di_scratch,  in hil_mlc_match_di_scratch()
122 				sizeof(mlc->di_scratch)))  in hil_mlc_match_di_scratch()
128 static int hil_mlc_find_free_di(hil_mlc *mlc)  in hil_mlc_find_free_di()  argument
139 			if (mlc->di_map[j] == idx)  in hil_mlc_find_free_di()
149 static inline void hil_mlc_clean_serio_map(hil_mlc *mlc)  in hil_mlc_clean_serio_map()  argument
157 			if (mlc->di_map[j] == idx)  in hil_mlc_clean_serio_map()
161 			mlc->serio_map[idx].di_revmap = -1;  in hil_mlc_clean_serio_map()
165 static void hil_mlc_send_polls(hil_mlc *mlc)  in hil_mlc_send_polls()  argument
172 	did = (mlc->ipacket[0] & HIL_PKT_ADDR_MASK) >> 8;  in hil_mlc_send_polls()
173 	serio = did ? mlc->serio[mlc->di_map[did - 1]] : NULL;  in hil_mlc_send_polls()
176 	while (mlc->icount < 15 - i) {  in hil_mlc_send_polls()
179 		p = mlc->ipacket[i];  in hil_mlc_send_polls()
189 			serio = did ? mlc->serio[mlc->di_map[did-1]] : NULL;  in hil_mlc_send_polls()
241 static int hilse_match(hil_mlc *mlc, int unused)  in hilse_match()  argument
245 	rc = hil_mlc_match_di_scratch(mlc);  in hilse_match()
247 		rc = hil_mlc_find_free_di(mlc);  in hilse_match()
254 		hil_mlc_copy_di_scratch(mlc, rc);  in hilse_match()
255 		mlc->di_map[mlc->ddi] = rc;  in hilse_match()
256 		mlc->serio_map[rc].di_revmap = mlc->ddi;  in hilse_match()
257 		hil_mlc_clean_serio_map(mlc);  in hilse_match()
258 		serio_rescan(mlc->serio[rc]);  in hilse_match()
262 	mlc->di_map[mlc->ddi] = rc;  in hilse_match()
266 	mlc->serio_map[rc].di_revmap = mlc->ddi;  in hilse_match()
267 	hil_mlc_clean_serio_map(mlc);  in hilse_match()
276 static int hilse_init_lcv(hil_mlc *mlc, int unused)  in hilse_init_lcv()  argument
280 	if (mlc->lcv && (now - mlc->lcv_time) < 5)  in hilse_init_lcv()
283 	mlc->lcv_time = now;  in hilse_init_lcv()
284 	mlc->lcv = 0;  in hilse_init_lcv()
289 static int hilse_inc_lcv(hil_mlc *mlc, int lim)  in hilse_inc_lcv()  argument
291 	return mlc->lcv++ >= lim ? -1 : 0;  in hilse_inc_lcv()
295 static int hilse_set_lcv(hil_mlc *mlc, int val)
297 	mlc->lcv = val;
304 static int hilse_set_ddi(hil_mlc *mlc, int val)  in hilse_set_ddi()  argument
306 	mlc->ddi = val;  in hilse_set_ddi()
307 	hil_mlc_clear_di_map(mlc, val + 1);  in hilse_set_ddi()
312 static int hilse_dec_ddi(hil_mlc *mlc, int unused)  in hilse_dec_ddi()  argument
314 	mlc->ddi--;  in hilse_dec_ddi()
315 	if (mlc->ddi <= -1) {  in hilse_dec_ddi()
316 		mlc->ddi = -1;  in hilse_dec_ddi()
317 		hil_mlc_clear_di_map(mlc, 0);  in hilse_dec_ddi()
320 	hil_mlc_clear_di_map(mlc, mlc->ddi + 1);  in hilse_dec_ddi()
325 static int hilse_inc_ddi(hil_mlc *mlc, int unused)  in hilse_inc_ddi()  argument
327 	BUG_ON(mlc->ddi >= 6);  in hilse_inc_ddi()
328 	mlc->ddi++;  in hilse_inc_ddi()
333 static int hilse_take_idd(hil_mlc *mlc, int unused)  in hilse_take_idd()  argument
342 	if (mlc->ipacket[0] & HIL_PKT_CMD)  in hilse_take_idd()
347 		if (((mlc->ipacket[i] & HIL_PKT_ADDR_MASK) ==  in hilse_take_idd()
348 		     (mlc->ipacket[0] & HIL_PKT_ADDR_MASK)) &&  in hilse_take_idd()
349 		    (mlc->ipacket[i] & HIL_PKT_CMD) &&  in hilse_take_idd()
350 		    ((mlc->ipacket[i] & HIL_PKT_DATA_MASK) == HIL_CMD_IDD))  in hilse_take_idd()
358 		if (mlc->ipacket[i])  in hilse_take_idd()
365 		mlc->di_scratch.idd[i] =  in hilse_take_idd()
366 			mlc->ipacket[i] & HIL_PKT_DATA_MASK;  in hilse_take_idd()
369 	if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_RSC)  in hilse_take_idd()
372 	if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_EXD)  in hilse_take_idd()
378 	mlc->ddi--;  in hilse_take_idd()
383 static int hilse_take_rsc(hil_mlc *mlc, int unused)  in hilse_take_rsc()  argument
388 		mlc->di_scratch.rsc[i] =  in hilse_take_rsc()
389 			mlc->ipacket[i] & HIL_PKT_DATA_MASK;  in hilse_take_rsc()
392 	if (mlc->di_scratch.idd[1] & HIL_IDD_HEADER_EXD)  in hilse_take_rsc()
398 static int hilse_take_exd(hil_mlc *mlc, int unused)  in hilse_take_exd()  argument
403 		mlc->di_scratch.exd[i] =  in hilse_take_exd()
404 			mlc->ipacket[i] & HIL_PKT_DATA_MASK;  in hilse_take_exd()
407 	if (mlc->di_scratch.exd[0] & HIL_EXD_HEADER_RNM)  in hilse_take_exd()
413 static int hilse_take_rnm(hil_mlc *mlc, int unused)  in hilse_take_rnm()  argument
418 		mlc->di_scratch.rnm[i] =  in hilse_take_rnm()
419 			mlc->ipacket[i] & HIL_PKT_DATA_MASK;  in hilse_take_rnm()
422 			mlc->di_scratch.rnm);  in hilse_take_rnm()
427 static int hilse_operate(hil_mlc *mlc, int repoll)  in hilse_operate()  argument
430 	if (mlc->opercnt == 0)  in hilse_operate()
432 	mlc->opercnt = 1;  in hilse_operate()
434 	hil_mlc_send_polls(mlc);  in hilse_operate()
439 	mlc->opercnt = 0;  in hilse_operate()
584 static inline void hilse_setup_input(hil_mlc *mlc, const struct hilse_node *node)  in hilse_setup_input()  argument
589 		mlc->imatch = node->object.packet;  in hilse_setup_input()
590 		mlc->imatch |= ((mlc->ddi + 2) << HIL_PKT_ADDR_SHIFT);  in hilse_setup_input()
593 		mlc->imatch = node->object.packet;  in hilse_setup_input()
594 		mlc->imatch |= ((mlc->ddi + 1) << HIL_PKT_ADDR_SHIFT);  in hilse_setup_input()
597 		mlc->imatch = node->object.packet;  in hilse_setup_input()
600 		mlc->imatch = 0;  in hilse_setup_input()
605 	mlc->istarted = 1;  in hilse_setup_input()
606 	mlc->intimeout = usecs_to_jiffies(node->arg);  in hilse_setup_input()
607 	mlc->instart = jiffies;  in hilse_setup_input()
608 	mlc->icount = 15;  in hilse_setup_input()
609 	memset(mlc->ipacket, 0, 16 * sizeof(hil_packet));  in hilse_setup_input()
610 	BUG_ON(down_trylock(&mlc->isem));  in hilse_setup_input()
618 static int hilse_donode(hil_mlc *mlc)  in hilse_donode()  argument
626 	if (mlc->seidx && mlc->seidx != seidx &&  in hilse_donode()
627 	    mlc->seidx != 41 && mlc->seidx != 42 && mlc->seidx != 43) {  in hilse_donode()
628 		printk(KERN_DEBUG PREFIX "z%i \n {%i}", doze, mlc->seidx);  in hilse_donode()
632 	seidx = mlc->seidx;  in hilse_donode()
634 	node = hil_mlc_se + mlc->seidx;  in hilse_donode()
642 		rc = node->object.func(mlc, node->arg);  in hilse_donode()
654 		write_lock_irqsave(&mlc->lock, flags);  in hilse_donode()
655 		rc = mlc->in(mlc, node->arg);  in hilse_donode()
659 			write_unlock_irqrestore(&mlc->lock, flags);  in hilse_donode()
668 		mlc->istarted = 0;  in hilse_donode()
669 		write_unlock_irqrestore(&mlc->lock, flags);  in hilse_donode()
673 		write_lock_irqsave(&mlc->lock, flags);  in hilse_donode()
675 		pack |= ((mlc->ddi + 1) << HIL_PKT_ADDR_SHIFT);  in hilse_donode()
679 		write_lock_irqsave(&mlc->lock, flags);  in hilse_donode()
681 		pack |= ((mlc->ddi + 2) << HIL_PKT_ADDR_SHIFT);  in hilse_donode()
685 		write_lock_irqsave(&mlc->lock, flags);  in hilse_donode()
688 		if (!mlc->istarted) {  in hilse_donode()
691 				hilse_setup_input(mlc, node + 1);  in hilse_donode()
694 		write_unlock_irqrestore(&mlc->lock, flags);  in hilse_donode()
696 		if (down_trylock(&mlc->osem)) {  in hilse_donode()
700 		up(&mlc->osem);  in hilse_donode()
702 		write_lock_irqsave(&mlc->lock, flags);  in hilse_donode()
703 		if (!mlc->ostarted) {  in hilse_donode()
704 			mlc->ostarted = 1;  in hilse_donode()
705 			mlc->opacket = pack;  in hilse_donode()
706 			rc = mlc->out(mlc);  in hilse_donode()
708 			write_unlock_irqrestore(&mlc->lock, flags);  in hilse_donode()
715 		mlc->ostarted = 0;  in hilse_donode()
716 		mlc->instart = jiffies;  in hilse_donode()
717 		write_unlock_irqrestore(&mlc->lock, flags);  in hilse_donode()
722 		write_lock_irqsave(&mlc->lock, flags);  in hilse_donode()
723 		rc = mlc->cts(mlc);  in hilse_donode()
725 		write_unlock_irqrestore(&mlc->lock, flags);  in hilse_donode()
747 		if (time_after(now, mlc->instart + mlc->intimeout))  in hilse_donode()
749 		mod_timer(&hil_mlcs_kicker, mlc->instart + mlc->intimeout);  in hilse_donode()
757 		mlc->seidx += nextidx & HILSEN_MASK;  in hilse_donode()
759 		mlc->seidx -= nextidx & HILSEN_MASK;  in hilse_donode()
761 		mlc->seidx = nextidx & HILSEN_MASK;  in hilse_donode()
776 		struct hil_mlc *mlc = list_entry(tmp, hil_mlc, list);  in hil_mlcs_process()  local
777 		while (hilse_donode(mlc) == 0) {  in hil_mlcs_process()
779 			if (mlc->seidx != 41 &&  in hil_mlcs_process()
780 			    mlc->seidx != 42 &&  in hil_mlcs_process()
781 			    mlc->seidx != 43)  in hil_mlcs_process()
811 	struct hil_mlc *mlc;  in hil_mlc_serio_write()  local
818 	mlc = map->mlc;  in hil_mlc_serio_write()
819 	BUG_ON(mlc == NULL);  in hil_mlc_serio_write()
821 	mlc->serio_opacket[map->didx] |=  in hil_mlc_serio_write()
822 		((hil_packet)c) << (8 * (3 - mlc->serio_oidx[map->didx]));  in hil_mlc_serio_write()
824 	if (mlc->serio_oidx[map->didx] >= 3) {  in hil_mlc_serio_write()
826 		if (!(mlc->serio_opacket[map->didx] & HIL_PKT_CMD))  in hil_mlc_serio_write()
828 		switch (mlc->serio_opacket[map->didx] & HIL_PKT_DATA_MASK) {  in hil_mlc_serio_write()
830 			idx = mlc->di[map->didx].idd;  in hil_mlc_serio_write()
833 			idx = mlc->di[map->didx].rsc;  in hil_mlc_serio_write()
836 			idx = mlc->di[map->didx].exd;  in hil_mlc_serio_write()
839 			idx = mlc->di[map->didx].rnm;  in hil_mlc_serio_write()
844 		mlc->serio_oidx[map->didx] = 0;  in hil_mlc_serio_write()
845 		mlc->serio_opacket[map->didx] = 0;  in hil_mlc_serio_write()
848 	mlc->serio_oidx[map->didx]++;  in hil_mlc_serio_write()
870 	mlc->serio_oidx[map->didx] = 0;  in hil_mlc_serio_write()
871 	mlc->serio_opacket[map->didx] = 0;  in hil_mlc_serio_write()
879 	struct hil_mlc *mlc;  in hil_mlc_serio_open()  local
887 	mlc = map->mlc;  in hil_mlc_serio_open()
888 	BUG_ON(mlc == NULL);  in hil_mlc_serio_open()
896 	struct hil_mlc *mlc;  in hil_mlc_serio_close()  local
901 	mlc = map->mlc;  in hil_mlc_serio_close()
902 	BUG_ON(mlc == NULL);  in hil_mlc_serio_close()
916 int hil_mlc_register(hil_mlc *mlc)  in hil_mlc_register()  argument
921 	BUG_ON(mlc == NULL);  in hil_mlc_register()
923 	mlc->istarted = 0;  in hil_mlc_register()
924 	mlc->ostarted = 0;  in hil_mlc_register()
926 	rwlock_init(&mlc->lock);  in hil_mlc_register()
927 	sema_init(&mlc->osem, 1);  in hil_mlc_register()
929 	sema_init(&mlc->isem, 1);  in hil_mlc_register()
930 	mlc->icount = -1;  in hil_mlc_register()
931 	mlc->imatch = 0;  in hil_mlc_register()
933 	mlc->opercnt = 0;  in hil_mlc_register()
935 	sema_init(&(mlc->csem), 0);  in hil_mlc_register()
937 	hil_mlc_clear_di_scratch(mlc);  in hil_mlc_register()
938 	hil_mlc_clear_di_map(mlc, 0);  in hil_mlc_register()
941 		hil_mlc_copy_di_scratch(mlc, i);  in hil_mlc_register()
943 		mlc->serio[i] = mlc_serio;  in hil_mlc_register()
944 		if (!mlc->serio[i]) {  in hil_mlc_register()
946 				kfree(mlc->serio[i]);  in hil_mlc_register()
956 		mlc_serio->port_data		= &(mlc->serio_map[i]);  in hil_mlc_register()
957 		mlc->serio_map[i].mlc		= mlc;  in hil_mlc_register()
958 		mlc->serio_map[i].didx		= i;  in hil_mlc_register()
959 		mlc->serio_map[i].di_revmap	= -1;  in hil_mlc_register()
960 		mlc->serio_opacket[i]		= 0;  in hil_mlc_register()
961 		mlc->serio_oidx[i]		= 0;  in hil_mlc_register()
965 	mlc->tasklet = &hil_mlcs_tasklet;  in hil_mlc_register()
968 	list_add_tail(&mlc->list, &hil_mlcs);  in hil_mlc_register()
969 	mlc->seidx = HILSEN_START;  in hil_mlc_register()
976 int hil_mlc_unregister(hil_mlc *mlc)  in hil_mlc_unregister()  argument
982 	BUG_ON(mlc == NULL);  in hil_mlc_unregister()
986 		if (list_entry(tmp, hil_mlc, list) == mlc)  in hil_mlc_unregister()
999 		serio_unregister_port(mlc->serio[i]);  in hil_mlc_unregister()
1000 		mlc->serio[i] = NULL;  in hil_mlc_unregister()