93 static int card_wait_for_busy_clear(const int ioaddr[],
95 static int card_wait_for_ready(const int ioaddr[], const char* name,
97 static int card_send_command(const int ioaddr[], const char* name,
101 static int sb1000_wait_for_ready(const int ioaddr[], const char* name);
102 static int sb1000_wait_for_ready_clear(const int ioaddr[],
104 static void sb1000_send_command(const int ioaddr[], const char* name,
106 static void sb1000_read_status(const int ioaddr[], unsigned char in[]);
107 static void sb1000_issue_read_command(const int ioaddr[],
111 static int sb1000_reset(const int ioaddr[], const char* name);
112 static int sb1000_check_CRC(const int ioaddr[], const char* name);
113 static inline int sb1000_start_get_set_command(const int ioaddr[],
115 static int sb1000_end_get_set_command(const int ioaddr[],
117 static int sb1000_activate(const int ioaddr[], const char* name);
118 static int sb1000_get_firmware_version(const int ioaddr[],
120 static int sb1000_get_frequency(const int ioaddr[], const char* name,
122 static int sb1000_set_frequency(const int ioaddr[], const char* name,
124 static int sb1000_get_PIDs(const int ioaddr[], const char* name,
126 static int sb1000_set_PIDs(const int ioaddr[], const char* name,
153 	unsigned short ioaddr[2], irq;
169 	ioaddr[0] = pnp_port_start(pdev, 0);
170 	ioaddr[1] = pnp_port_start(pdev, 0);
174 	if (!request_region(ioaddr[0], 16, "sb1000"))
176 	if (!request_region(ioaddr[1], 16, "sb1000"))
186 	dev->base_addr = ioaddr[0];
188 	dev->mem_start = ioaddr[1];
225 	release_region(ioaddr[1], 16);
227 	release_region(ioaddr[0], 16);
262 card_wait_for_busy_clear(const int ioaddr[], const char* name)
267 	a = inb(ioaddr[0] + 7);
273 		a = inb(ioaddr[0] + 7);
286 card_wait_for_ready(const int ioaddr[], const char* name, unsigned char in[])
291 	a = inb(ioaddr[1] + 6);
297 		a = inb(ioaddr[1] + 6);
305 	in[1] = inb(ioaddr[0] + 1);
306 	in[2] = inb(ioaddr[0] + 2);
307 	in[3] = inb(ioaddr[0] + 3);
308 	in[4] = inb(ioaddr[0] + 4);
309 	in[0] = inb(ioaddr[0] + 5);
310 	in[6] = inb(ioaddr[0] + 6);
311 	in[5] = inb(ioaddr[1] + 6);
317 card_send_command(const int ioaddr[], const char* name,
322 	if ((status = card_wait_for_busy_clear(ioaddr, name)))
324 	outb(0xa0, ioaddr[0] + 6);
325 	outb(out[2], ioaddr[0] + 1);
326 	outb(out[3], ioaddr[0] + 2);
327 	outb(out[4], ioaddr[0] + 3);
328 	outb(out[5], ioaddr[0] + 4);
329 	outb(out[1], ioaddr[0] + 5);
330 	outb(0xa0, ioaddr[0] + 6);
331 	outb(out[0], ioaddr[0] + 7);
333 		if ((status = card_wait_for_ready(ioaddr, name, in)))
335 		inb(ioaddr[0] + 7);
366 sb1000_wait_for_ready(const int ioaddr[], const char* name)
371 	while (inb(ioaddr[1] + 6) & 0x80) {
379 	while (!(inb(ioaddr[1] + 6) & 0x40)) {
386 	inb(ioaddr[0] + 7);
392 sb1000_wait_for_ready_clear(const int ioaddr[], const char* name)
397 	while (inb(ioaddr[1] + 6) & 0x80) {
405 	while (inb(ioaddr[1] + 6) & 0x40) {
417 sb1000_send_command(const int ioaddr[], const char* name,
420 	outb(out[2], ioaddr[0] + 1);
421 	outb(out[3], ioaddr[0] + 2);
422 	outb(out[4], ioaddr[0] + 3);
423 	outb(out[5], ioaddr[0] + 4);
424 	outb(out[1], ioaddr[0] + 5);
425 	outb(out[0], ioaddr[0] + 7);
433 sb1000_read_status(const int ioaddr[], unsigned char in[])
435 	in[1] = inb(ioaddr[0] + 1);
436 	in[2] = inb(ioaddr[0] + 2);
437 	in[3] = inb(ioaddr[0] + 3);
438 	in[4] = inb(ioaddr[0] + 4);
439 	in[0] = inb(ioaddr[0] + 5);
444 sb1000_issue_read_command(const int ioaddr[], const char* name)
448 	sb1000_wait_for_ready_clear(ioaddr, name);
449 	outb(0xa0, ioaddr[0] + 6);
450 	sb1000_send_command(ioaddr, name, Command0);
459 sb1000_reset(const int ioaddr[], const char* name)
466 	port = ioaddr[1] + 6;
480 	if ((status = card_send_command(ioaddr, name, Command0, st)))
489 sb1000_check_CRC(const int ioaddr[], const char* name)
497 	if ((status = card_send_command(ioaddr, name, Command0, st)))
506 sb1000_start_get_set_command(const int ioaddr[], const char* name)
512 	return card_send_command(ioaddr, name, Command0, st);
516 sb1000_end_get_set_command(const int ioaddr[], const char* name)
524 	if ((status = card_send_command(ioaddr, name, Command0, st)))
526 	return card_send_command(ioaddr, name, Command1, st);
530 sb1000_activate(const int ioaddr[], const char* name)
539 	if ((status = card_send_command(ioaddr, name, Command0, st)))
541 	if ((status = card_send_command(ioaddr, name, Command1, st)))
544     	if ((status = sb1000_start_get_set_command(ioaddr, name)))
549     return sb1000_start_get_set_command(ioaddr, name);
554 sb1000_get_firmware_version(const int ioaddr[], const char* name,
562 	if ((status = sb1000_start_get_set_command(ioaddr, name)))
564 	if ((status = card_send_command(ioaddr, name, Command0, st)))
571 		return sb1000_end_get_set_command(ioaddr, name);
578 sb1000_get_frequency(const int ioaddr[], const char* name, int* frequency)
586 	if ((status = sb1000_start_get_set_command(ioaddr, name)))
588 	if ((status = card_send_command(ioaddr, name, Command0, st)))
591 	return sb1000_end_get_set_command(ioaddr, name);
596 sb1000_set_frequency(const int ioaddr[], const char* name, int frequency)
612 	if ((status = sb1000_start_get_set_command(ioaddr, name)))
621 	return card_send_command(ioaddr, name, Command0, st);
626 sb1000_get_PIDs(const int ioaddr[], const char* name, short PID[])
637 	if ((status = sb1000_start_get_set_command(ioaddr, name)))
640 	if ((status = card_send_command(ioaddr, name, Command0, st)))
644 	if ((status = card_send_command(ioaddr, name, Command1, st)))
648 	if ((status = card_send_command(ioaddr, name, Command2, st)))
652 	if ((status = card_send_command(ioaddr, name, Command3, st)))
656 	return sb1000_end_get_set_command(ioaddr, name);
661 sb1000_set_PIDs(const int ioaddr[], const char* name, const short PID[])
674 	if ((status = sb1000_start_get_set_command(ioaddr, name)))
681 	if ((status = card_send_command(ioaddr, name, Command0, st)))
688 	if ((status = card_send_command(ioaddr, name, Command1, st)))
695 	if ((status = card_send_command(ioaddr, name, Command2, st)))
702 	if ((status = card_send_command(ioaddr, name, Command3, st)))
705 	if ((status = card_send_command(ioaddr, name, Command4, st)))
707 	return sb1000_end_get_set_command(ioaddr, name);
748 	int ioaddr, ns;
764 	ioaddr = dev->base_addr;
766 	insw(ioaddr, (unsigned short*) st, 1);
811 		insw(ioaddr, buffer, NewDatagramHeaderSize / 2);
821 			insw(ioaddr, buffer, NewDatagramDataSize / 2);
831 			insw(ioaddr, buffer, NewDatagramDataSize / 2);
842 			insw(ioaddr, buffer, NewDatagramDataSize / 2);
848 		insw(ioaddr, skb_put(skb, NewDatagramDataSize),
853 		insw(ioaddr, buffer, ContDatagramHeaderSize / 2);
860 			insw(ioaddr, buffer, ContDatagramDataSize / 2);
864 		insw(ioaddr, skb_put(skb, ContDatagramDataSize),
883 	insw(ioaddr, buffer, FrameSize / 2);
910 	int ioaddr[2];
914 	ioaddr[0] = dev->base_addr;
916 	ioaddr[1] = dev->mem_start;
919 	sb1000_wait_for_ready_clear(ioaddr, name);
920 	sb1000_send_command(ioaddr, name, Command0);
921 	sb1000_wait_for_ready(ioaddr, name);
922 	sb1000_read_status(ioaddr, st);
935 	int ioaddr[2], status;
939 	ioaddr[0] = dev->base_addr;
941 	ioaddr[1] = dev->mem_start;
945 	if ((status = sb1000_reset(ioaddr, name)))
948 	if ((status = sb1000_check_CRC(ioaddr, name)))
980 	if ((status = sb1000_activate(ioaddr, name)))
983 	if ((status = sb1000_get_firmware_version(ioaddr, name, version, 0)))
1000 	int ioaddr[2], status, frequency;
1007 	ioaddr[0] = dev->base_addr;
1009 	ioaddr[1] = dev->mem_start;
1025 		if ((status = sb1000_get_firmware_version(ioaddr, name, version, 1)))
1032 		if ((status = sb1000_get_frequency(ioaddr, name, &frequency)))
1043 		if ((status = sb1000_set_frequency(ioaddr, name, frequency)))
1048 		if ((status = sb1000_get_PIDs(ioaddr, name, PID)))
1059 		if ((status = sb1000_set_PIDs(ioaddr, name, PID)))
1097 	int ioaddr[2];
1103 	ioaddr[0] = dev->base_addr;
1105 	ioaddr[1] = dev->mem_start;
1109 	st = inb(ioaddr[1] + 6);
1117 	st = inb(ioaddr[0] + 7);
1123 	sb1000_issue_read_command(ioaddr, name);
1126 		sb1000_issue_read_command(ioaddr, name);
1129 		sb1000_wait_for_ready_clear(ioaddr, name);
1130 		sb1000_send_command(ioaddr, name, Command0);
1131 		sb1000_wait_for_ready(ioaddr, name);
1132 		sb1000_issue_read_command(ioaddr, name);
1135 		sb1000_wait_for_ready_clear(ioaddr, name);
1136 		sb1000_send_command(ioaddr, name, Command1);
1137 		sb1000_wait_for_ready(ioaddr, name);
1138 		sb1000_issue_read_command(ioaddr, name);
1148 	int ioaddr[2];
1156 	ioaddr[0] = dev->base_addr;
1158 	ioaddr[1] = dev->mem_start;
1162 	release_region(ioaddr[1], SB1000_IO_EXTENT);
1163 	release_region(ioaddr[0], SB1000_IO_EXTENT);

Indexes created Wed Oct 10 22:18:05 CEST 2012