1 /*
2 * natfeat.c - ARAnyM hardware support via Native Features (natfeats)
3 *
4 * Copyright (c) 2005 Petr Stehlik of ARAnyM dev team
5 *
6 * Reworked for Linux by Roman Zippel <zippel@linux-m68k.org>
7 *
8 * This software may be used and distributed according to the terms of
9 * the GNU General Public License (GPL), incorporated herein by reference.
10 */
11
12 #include <linux/types.h>
13 #include <linux/console.h>
14 #include <linux/string.h>
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/io.h>
18 #include <asm/machdep.h>
19 #include <asm/natfeat.h>
20
21 asm("\n"
22 " .global nf_get_id,nf_call\n"
23 "nf_get_id:\n"
24 " .short 0x7300\n"
25 " rts\n"
26 "nf_call:\n"
27 " .short 0x7301\n"
28 " rts\n"
29 "1: moveq.l #0,%d0\n"
30 " rts\n"
31 " .section __ex_table,\"a\"\n"
32 " .long nf_get_id,1b\n"
33 " .long nf_call,1b\n"
34 " .previous");
35 EXPORT_SYMBOL_GPL(nf_get_id);
36 EXPORT_SYMBOL_GPL(nf_call);
37
nfprint(const char * fmt,...)38 void nfprint(const char *fmt, ...)
39 {
40 static char buf[256];
41 va_list ap;
42 int n;
43
44 va_start(ap, fmt);
45 n = vsnprintf(buf, 256, fmt, ap);
46 nf_call(nf_get_id("NF_STDERR"), buf);
47 va_end(ap);
48 }
49
nf_poweroff(void)50 static void nf_poweroff(void)
51 {
52 long id = nf_get_id("NF_SHUTDOWN");
53
54 if (id)
55 nf_call(id);
56 }
57
nf_init(void)58 void nf_init(void)
59 {
60 unsigned long id, version;
61 char buf[256];
62
63 id = nf_get_id("NF_VERSION");
64 if (!id)
65 return;
66 version = nf_call(id);
67
68 id = nf_get_id("NF_NAME");
69 if (!id)
70 return;
71 nf_call(id, buf, 256);
72 buf[255] = 0;
73
74 pr_info("NatFeats found (%s, %lu.%lu)\n", buf, version >> 16,
75 version & 0xffff);
76
77 mach_power_off = nf_poweroff;
78 }
79