mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
94 lines
1.9 KiB
94 lines
1.9 KiB
/* |
|
* natfeat.c - ARAnyM hardware support via Native Features (natfeats) |
|
* |
|
* Copyright (c) 2005 Petr Stehlik of ARAnyM dev team |
|
* |
|
* Reworked for Linux by Roman Zippel <[email protected]> |
|
* |
|
* This software may be used and distributed according to the terms of |
|
* the GNU General Public License (GPL), incorporated herein by reference. |
|
*/ |
|
|
|
#include <linux/init.h> |
|
#include <linux/types.h> |
|
#include <linux/console.h> |
|
#include <linux/string.h> |
|
#include <linux/kernel.h> |
|
#include <linux/module.h> |
|
#include <linux/io.h> |
|
#include <asm/machdep.h> |
|
#include <asm/natfeat.h> |
|
|
|
extern long nf_get_id_phys(unsigned long feature_name); |
|
|
|
asm("\n" |
|
" .global nf_get_id_phys,nf_call\n" |
|
"nf_get_id_phys:\n" |
|
" .short 0x7300\n" |
|
" rts\n" |
|
"nf_call:\n" |
|
" .short 0x7301\n" |
|
" rts\n" |
|
"1: moveq.l #0,%d0\n" |
|
" rts\n" |
|
" .section __ex_table,\"a\"\n" |
|
" .long nf_get_id_phys,1b\n" |
|
" .long nf_call,1b\n" |
|
" .previous"); |
|
EXPORT_SYMBOL_GPL(nf_call); |
|
|
|
long nf_get_id(const char *feature_name) |
|
{ |
|
/* feature_name may be in vmalloc()ed memory, so make a copy */ |
|
char name_copy[32]; |
|
size_t n; |
|
|
|
n = strlcpy(name_copy, feature_name, sizeof(name_copy)); |
|
if (n >= sizeof(name_copy)) |
|
return 0; |
|
|
|
return nf_get_id_phys(virt_to_phys(name_copy)); |
|
} |
|
EXPORT_SYMBOL_GPL(nf_get_id); |
|
|
|
void nfprint(const char *fmt, ...) |
|
{ |
|
static char buf[256]; |
|
va_list ap; |
|
int n; |
|
|
|
va_start(ap, fmt); |
|
n = vsnprintf(buf, 256, fmt, ap); |
|
nf_call(nf_get_id("NF_STDERR"), virt_to_phys(buf)); |
|
va_end(ap); |
|
} |
|
|
|
static void nf_poweroff(void) |
|
{ |
|
long id = nf_get_id("NF_SHUTDOWN"); |
|
|
|
if (id) |
|
nf_call(id); |
|
} |
|
|
|
void __init nf_init(void) |
|
{ |
|
unsigned long id, version; |
|
char buf[256]; |
|
|
|
id = nf_get_id("NF_VERSION"); |
|
if (!id) |
|
return; |
|
version = nf_call(id); |
|
|
|
id = nf_get_id("NF_NAME"); |
|
if (!id) |
|
return; |
|
nf_call(id, virt_to_phys(buf), 256); |
|
buf[255] = 0; |
|
|
|
pr_info("NatFeats found (%s, %lu.%lu)\n", buf, version >> 16, |
|
version & 0xffff); |
|
|
|
mach_power_off = nf_poweroff; |
|
}
|
|
|