~ubuntu-branches/ubuntu/precise/linux-ti-omap4/precise

« back to all changes in this revision

Viewing changes to arch/m68k/emu/natfeat.c

  • Committer: Bazaar Package Importer
  • Author(s): Paolo Pisati
  • Date: 2011-06-29 15:23:51 UTC
  • mfrom: (26.1.1 natty-proposed)
  • Revision ID: james.westby@ubuntu.com-20110629152351-xs96tm303d95rpbk
Tags: 3.0.0-1200.2
* Rebased against 3.0.0-6.7
* BSP from TI based on 3.0.0

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
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
 
 
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
 
 
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
 
 
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
}