1) wraps the s3 parts of chipset code/memory init code with if CONFIG_HAVE_ACPI_RESUME == 1 getting rid of ugly define in romstage.c

2) the patch implements get_cbmem_toc in chipset specific way if defined.
On Intel targets it should be unchanged. On K8T890 the the cbmem_toc is read from NVRAM. Why you ask? Because we cannot do it as on intel, because the framebuffer might be there making it hard to look for it in memory (and remember we need it so early that everying is uncached)

3) The patch removes hardcoded limits for suspend/resume save area (it was 1MB) on intel. Now it computes right numbers itself.

4) it impelements saving the memory during CAR to reserved range in sane way. First the sysinfo area (CAR data) is copied, then the rest after car is disabled (cached copy is used). I changed bit also the the copy of CAR area is now done uncached for target which I feel is more right.

I think I did not change the Intel suspend/resume behaviour but best would be if someone can test it. Please note this patch was unfinished on my drive since ages and it would be very nice to get it in to prevent bit rotten it again.
Now I feel it is done good way and should not break anything. I did a test with abuild and it seems fine.

Signed-off-by: Rudolf Marek <r.marek@assembler.cz> 
Acked-by: Tobias Diedrich <ranma+coreboot@tdiedrich.de>
Acked-by: Stefan Reinauer <stepan@coreboot.org>



git-svn-id: svn://svn.coreboot.org/coreboot/trunk@6117 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
Rudolf Marek 2010-11-22 22:00:52 +00:00
parent 9b5295f522
commit bcaea142f3
18 changed files with 133 additions and 64 deletions

View File

@ -470,17 +470,6 @@ void suspend_resume(void)
{ {
void *wake_vec; void *wake_vec;
#if 0
#if CONFIG_MEM_TRAIN_SEQ != 0
#error "So far it works on AMD and CONFIG_MEM_TRAIN_SEQ == 0"
#endif
#if CONFIG_RAMBASE < 0x1F00000
#error "For ACPI RESUME you need to have CONFIG_RAMBASE at least 31MB"
#error "Chipset support (S3_NVRAM_EARLY and ACPI_IS_WAKEUP_EARLY functions and memory ctrl)"
#error "And coreboot memory reserved in mainboard.c"
#endif
#endif
/* If we happen to be resuming find wakeup vector and jump to OS. */ /* If we happen to be resuming find wakeup vector and jump to OS. */
wake_vec = acpi_find_wakeup_vector(); wake_vec = acpi_find_wakeup_vector();
if (wake_vec) if (wake_vec)

View File

@ -214,7 +214,7 @@ struct lb_memory *write_tables(void)
* it begin there during reboot time. We don't need the pointer, nor * it begin there during reboot time. We don't need the pointer, nor
* the result right now. If it fails, ACPI resume will be disabled. * the result right now. If it fails, ACPI resume will be disabled.
*/ */
cbmem_add(CBMEM_ID_RESUME, 1024 * (1024-64)); cbmem_add(CBMEM_ID_RESUME, HIGH_MEMORY_SAVE);
#endif #endif
#if CONFIG_MULTIBOOT #if CONFIG_MULTIBOOT

View File

@ -27,6 +27,45 @@ static void inline __attribute__((always_inline)) memcopy(void *dest, const voi
: "0" (bytes / 4), "g" (bytes), "1" ((long)dest), "2" ((long)src) : "0" (bytes / 4), "g" (bytes), "1" ((long)dest), "2" ((long)src)
: "memory", "cc"); : "memory", "cc");
} }
#if CONFIG_HAVE_ACPI_RESUME == 1
static inline void *backup_resume(void) {
unsigned long high_ram_base;
void *resume_backup_memory;
int suspend = acpi_is_wakeup_early();
if (!suspend)
return NULL;
/* Start address of high memory tables */
high_ram_base = (u32) get_cbmem_toc();
print_debug_pcar("CBMEM TOC is at: ", (uint32_t)high_ram_base);
print_debug_pcar("CBMEM TOC 0-size: ",(uint32_t)(high_ram_base + HIGH_MEMORY_SIZE + 4096));
cbmem_reinit((u64)high_ram_base);
resume_backup_memory = cbmem_find(CBMEM_ID_RESUME);
/* copy 1MB - 64K to high tables ram_base to prevent memory corruption
* through stage 2. We could keep stuff like stack and heap in high tables
* memory completely, but that's a wonderful clean up task for another
* day.
*/
if (resume_backup_memory) {
print_debug_pcar("Will copy coreboot region to: ", (uint32_t) resume_backup_memory);
/* copy only backup only memory used for CAR */
memcopy(resume_backup_memory+HIGH_MEMORY_SAVE-CONFIG_DCACHE_RAM_SIZE,
(void *)((CONFIG_RAMTOP)-CONFIG_DCACHE_RAM_SIZE),
CONFIG_DCACHE_RAM_SIZE); //inline
}
return resume_backup_memory;
}
#endif
/* Disable Erratum 343 Workaround, see RevGuide for Fam10h, Pub#41322 Rev 3.33 */ /* Disable Erratum 343 Workaround, see RevGuide for Fam10h, Pub#41322 Rev 3.33 */
static void vErrata343(void) static void vErrata343(void)
@ -43,7 +82,9 @@ static void vErrata343(void)
static void post_cache_as_ram(void) static void post_cache_as_ram(void)
{ {
#if CONFIG_HAVE_ACPI_RESUME == 1
void *resume_backup_memory;
#endif
#if 1 #if 1
{ {
/* Check value of esp to verify if we have enough rom for stack in Cache as RAM */ /* Check value of esp to verify if we have enough rom for stack in Cache as RAM */
@ -66,17 +107,16 @@ static void post_cache_as_ram(void)
#error "You need to set CONFIG_RAMTOP greater than 1M" #error "You need to set CONFIG_RAMTOP greater than 1M"
#endif #endif
/* So we can access RAM from [1M, CONFIG_RAMTOP) */ #if CONFIG_HAVE_ACPI_RESUME == 1
set_var_mtrr(0, 0x00000000, CONFIG_RAMTOP, MTRR_TYPE_WRBACK); resume_backup_memory = backup_resume();
#endif
// dump_mem(CONFIG_DCACHE_RAM_BASE+CONFIG_DCACHE_RAM_SIZE-0x8000, CONFIG_DCACHE_RAM_BASE+CONFIG_DCACHE_RAM_SIZE-0x7c00);
print_debug("Copying data from cache to RAM -- switching to use RAM as stack... "); print_debug("Copying data from cache to RAM -- switching to use RAM as stack... ");
/* from here don't store more data in CAR */ /* from here don't store more data in CAR */
vErrata343(); vErrata343();
memcopy((void *)((CONFIG_RAMTOP)-CONFIG_DCACHE_RAM_SIZE), (void *)CONFIG_DCACHE_RAM_BASE, CONFIG_DCACHE_RAM_SIZE); //inline memcopy((void *)((CONFIG_RAMTOP)-CONFIG_DCACHE_RAM_SIZE), (void *)CONFIG_DCACHE_RAM_BASE, CONFIG_DCACHE_RAM_SIZE); //inline
// dump_mem((CONFIG_RAMTOP) - 0x8000, (CONFIG_RAMTOP) - 0x7c00);
__asm__ volatile ( __asm__ volatile (
/* set new esp */ /* before CONFIG_RAMBASE */ /* set new esp */ /* before CONFIG_RAMBASE */
@ -94,9 +134,25 @@ static void post_cache_as_ram(void)
print_debug_pcar("testx = ", testx); print_debug_pcar("testx = ", testx);
print_debug("Disabling cache as ram now \n"); print_debug("Disabling cache as ram now \n");
disable_cache_as_ram_bsp(); disable_cache_as_ram_bsp();
disable_cache();
set_var_mtrr(0, 0x00000000, CONFIG_RAMTOP, MTRR_TYPE_WRBACK);
enable_cache();
#if CONFIG_HAVE_ACPI_RESUME == 1
/* now copy the rest of the area, using the WB method because we already
run normal RAM */
if (resume_backup_memory) {
memcopy(resume_backup_memory,
(void *)(CONFIG_RAMBASE),
(CONFIG_RAMTOP) - CONFIG_RAMBASE - CONFIG_DCACHE_RAM_SIZE);
}
#endif
print_debug("Clearing initial memory region: "); print_debug("Clearing initial memory region: ");
#if CONFIG_HAVE_ACPI_RESUME == 1 #if CONFIG_HAVE_ACPI_RESUME == 1
/* clear only coreboot used region of memory. Note: this may break ECC enabled boards */ /* clear only coreboot used region of memory. Note: this may break ECC enabled boards */
memset((void*) CONFIG_RAMBASE, 0, (CONFIG_RAMTOP) - CONFIG_RAMBASE - CONFIG_DCACHE_RAM_SIZE); memset((void*) CONFIG_RAMBASE, 0, (CONFIG_RAMTOP) - CONFIG_RAMBASE - CONFIG_DCACHE_RAM_SIZE);
@ -105,8 +161,6 @@ static void post_cache_as_ram(void)
#endif #endif
print_debug("Done\n"); print_debug("Done\n");
// dump_mem((CONFIG_RAMTOP) - 0x8000, (CONFIG_RAMTOP) - 0x7c00);
set_sysinfo_in_ram(1); // So other core0 could start to train mem set_sysinfo_in_ram(1); // So other core0 could start to train mem
#if CONFIG_MEM_TRAIN_SEQ == 1 #if CONFIG_MEM_TRAIN_SEQ == 1

View File

@ -24,7 +24,7 @@
#define HIGH_MEMORY_TABLES ( 64 * 1024 ) #define HIGH_MEMORY_TABLES ( 64 * 1024 )
#if CONFIG_HAVE_ACPI_RESUME #if CONFIG_HAVE_ACPI_RESUME
#define HIGH_MEMORY_SIZE ( 1024 * 1024 ) #define HIGH_MEMORY_SIZE ((CONFIG_RAMTOP - CONFIG_RAMBASE) + HIGH_MEMORY_TABLES)
#define HIGH_MEMORY_SAVE ( HIGH_MEMORY_SIZE - HIGH_MEMORY_TABLES ) #define HIGH_MEMORY_SAVE ( HIGH_MEMORY_SIZE - HIGH_MEMORY_TABLES )
#else #else
#define HIGH_MEMORY_SIZE HIGH_MEMORY_TABLES #define HIGH_MEMORY_SIZE HIGH_MEMORY_TABLES
@ -48,4 +48,6 @@ void *cbmem_find(u32 id);
void cbmem_list(void); void cbmem_list(void);
void cbmem_arch_init(void); void cbmem_arch_init(void);
struct cbmem_entry *get_cbmem_toc(void);
void set_cbmem_toc(struct cbmem_entry *);
#endif #endif

View File

@ -36,13 +36,34 @@ struct cbmem_entry {
u64 size; u64 size;
} __attribute__((packed)); } __attribute__((packed));
#ifndef __PRE_RAM__
struct cbmem_entry *bss_cbmem_toc; #ifdef __PRE_RAM__
#define get_cbmem_toc() bss_cbmem_toc
#else /* note this should be done as weak function but we do #include
of C files in the romstage breaking this (in same compile
unit is weak and non weak function
struct cbmem_entry *__attribute__((weak)) get_cbmem_toc(void)
*/
#ifndef get_cbmem_toc
#define get_cbmem_toc() (struct cbmem_entry *)(get_top_of_ram() - HIGH_MEMORY_SIZE) #define get_cbmem_toc() (struct cbmem_entry *)(get_top_of_ram() - HIGH_MEMORY_SIZE)
#endif #endif
#else
static struct cbmem_entry *bss_cbmem_toc;
struct cbmem_entry *__attribute__((weak)) get_cbmem_toc(void)
{
return bss_cbmem_toc;
}
void __attribute__((weak)) set_cbmem_toc(struct cbmem_entry * x)
{
/* do nothing, this should be called by chipset to save TOC in NVRAM */
}
#endif
/** /**
* cbmem is a simple mechanism to do some kind of book keeping of the coreboot * cbmem is a simple mechanism to do some kind of book keeping of the coreboot
* high tables memory. This is a small amount of memory which is "stolen" from * high tables memory. This is a small amount of memory which is "stolen" from
@ -70,6 +91,10 @@ void cbmem_init(u64 baseaddr, u64 size)
for (;;) ; for (;;) ;
} }
/* we don't need to call this in romstage, usefull only from ramstage */
#ifndef __PRE_RAM__
set_cbmem_toc((struct cbmem_entry *)(unsigned long)baseaddr);
#endif
memset(cbmem_toc, 0, CBMEM_TOC_RESERVED); memset(cbmem_toc, 0, CBMEM_TOC_RESERVED);
cbmem_toc[0] = (struct cbmem_entry) { cbmem_toc[0] = (struct cbmem_entry) {

View File

@ -79,7 +79,6 @@ void soft_reset(void)
} }
} }
// defines S3_NVRAM_EARLY:
#include "southbridge/via/k8t890/k8t890_early_car.c" #include "southbridge/via/k8t890/k8t890_early_car.c"
#include "northbridge/amd/amdk8/amdk8.h" #include "northbridge/amd/amdk8/amdk8.h"
#include "northbridge/amd/amdk8/incoherent_ht.c" #include "northbridge/amd/amdk8/incoherent_ht.c"

View File

@ -79,7 +79,6 @@ void soft_reset(void)
} }
} }
// defines S3_NVRAM_EARLY:
#include "southbridge/via/k8t890/k8t890_early_car.c" #include "southbridge/via/k8t890/k8t890_early_car.c"
#include "northbridge/amd/amdk8/amdk8.h" #include "northbridge/amd/amdk8/amdk8.h"
#include "northbridge/amd/amdk8/incoherent_ht.c" #include "northbridge/amd/amdk8/incoherent_ht.c"

View File

@ -35,6 +35,7 @@ config BOARD_SPECIFIC_OPTIONS # dummy
select RAMINIT_SYSINFO select RAMINIT_SYSINFO
select VGA select VGA
select TINY_BOOTBLOCK select TINY_BOOTBLOCK
select HAVE_ACPI_RESUME
select HAVE_MAINBOARD_RESOURCES select HAVE_MAINBOARD_RESOURCES
select QRANK_DIMM_SUPPORT select QRANK_DIMM_SUPPORT
select SET_FIDVID select SET_FIDVID

View File

@ -34,13 +34,6 @@ int add_mainboard_resources(struct lb_memory *mem)
lb_add_memory_range(mem, LB_MEM_RESERVED, lb_add_memory_range(mem, LB_MEM_RESERVED,
uma_memory_base, uma_memory_size); uma_memory_base, uma_memory_size);
#endif #endif
#if CONFIG_HAVE_ACPI_RESUME == 1
lb_add_memory_range(mem, LB_MEM_RESERVED,
CONFIG_RAMBASE, ((CONFIG_RAMTOP) - CONFIG_RAMBASE));
lb_add_memory_range(mem, LB_MEM_RESERVED,
CONFIG_DCACHE_RAM_BASE, CONFIG_DCACHE_RAM_SIZE);
#endif
return 0; return 0;
} }

View File

@ -62,7 +62,6 @@ static inline int spd_read_byte(unsigned device, unsigned address)
return smbus_read_byte(device, address); return smbus_read_byte(device, address);
} }
// defines S3_NVRAM_EARLY:
#include "southbridge/via/k8t890/k8t890_early_car.c" #include "southbridge/via/k8t890/k8t890_early_car.c"
#include "northbridge/amd/amdk8/amdk8.h" #include "northbridge/amd/amdk8/amdk8.h"
#include "northbridge/amd/amdk8/incoherent_ht.c" #include "northbridge/amd/amdk8/incoherent_ht.c"
@ -75,6 +74,15 @@ static inline int spd_read_byte(unsigned device, unsigned address)
#define SB_VFSMAF 0 #define SB_VFSMAF 0
// Now, this needs to be included because it relies on the symbol
// __PRE_RAM__ being set during CAR stage (in order to compile the
// BSS free versions of the functions). Either rewrite the code
// to be always BSS free, or invent a flag that's better suited than
// __PRE_RAM__ to determine whether we're in ram init stage (stage 1)
//
#include "lib/cbmem.c"
/* this function might fail on some K8 CPUs with errata #181 */ /* this function might fail on some K8 CPUs with errata #181 */
static void ldtstop_sb(void) static void ldtstop_sb(void)
{ {

View File

@ -64,7 +64,6 @@ static inline int spd_read_byte(unsigned device, unsigned address)
return smbus_read_byte(device, address); return smbus_read_byte(device, address);
} }
// defines S3_NVRAM_EARLY:
#include "southbridge/via/k8t890/k8t890_early_car.c" #include "southbridge/via/k8t890/k8t890_early_car.c"
#include "northbridge/amd/amdk8/amdk8.h" #include "northbridge/amd/amdk8/amdk8.h"
#include "northbridge/amd/amdk8/incoherent_ht.c" #include "northbridge/amd/amdk8/incoherent_ht.c"

View File

@ -819,7 +819,8 @@ static u32 hoist_memory(unsigned long hole_startk, int node_id)
#endif #endif
#if CONFIG_WRITE_HIGH_TABLES==1 #if CONFIG_WRITE_HIGH_TABLES==1
#define HIGH_TABLES_SIZE 64 /* maximum size of high tables in KB */ #include <cbmem.h>
#define HIGH_TABLES_SIZE ((HIGH_MEMORY_SIZE + 1024) / 1024)
extern uint64_t high_tables_base, high_tables_size; extern uint64_t high_tables_base, high_tables_size;
#endif #endif

View File

@ -2988,14 +2988,15 @@ static void set_hw_mem_hole(int controllers, const struct mem_controller *ctrl)
} }
#endif #endif
#if CONFIG_HAVE_ACPI_RESUME == 1
#include "exit_from_self.c" #include "exit_from_self.c"
#endif
static void sdram_enable(int controllers, const struct mem_controller *ctrl, static void sdram_enable(int controllers, const struct mem_controller *ctrl,
struct sys_info *sysinfo) struct sys_info *sysinfo)
{ {
int i; int i;
#ifdef ACPI_IS_WAKEUP_EARLY #if CONFIG_HAVE_ACPI_RESUME == 1
int suspend = acpi_is_wakeup_early(); int suspend = acpi_is_wakeup_early();
#else #else
int suspend = 0; int suspend = 0;

View File

@ -1826,25 +1826,7 @@ static void set_sysinfo_in_ram(unsigned val)
set_htic_bit(0, val, 9); set_htic_bit(0, val, 9);
} }
#ifdef S3_NVRAM_EARLY #if CONFIG_HAVE_ACPI_RESUME == 1
// Don't define these prototypes as the real functions are already included
// at this point.
//
//int s3_save_nvram_early(u32 dword, int size, int nvram_pos);
//int s3_load_nvram_early(int size, u32 *old_dword, int nvram_pos);
#else
static inline int s3_save_nvram_early(u32 dword, int size, int nvram_pos)
{
return nvram_pos;
}
static inline int s3_load_nvram_early(int size, u32 *old_dword, int nvram_pos)
{
die("No memory NVRAM loader for DQS data! Unable to restore memory state\n");
return nvram_pos; /* Make GCC happy */
}
#endif
#if CONFIG_MEM_TRAIN_SEQ == 0 #if CONFIG_MEM_TRAIN_SEQ == 0
static int save_index_to_pos(unsigned int dev, int size, int index, int nvram_pos) static int save_index_to_pos(unsigned int dev, int size, int index, int nvram_pos)
@ -1930,6 +1912,7 @@ static void dqs_restore_MC_NVRAM(unsigned int dev)
reg |= pci_read_config32(dev, DRAM_CONFIG_HIGH); reg |= pci_read_config32(dev, DRAM_CONFIG_HIGH);
pci_write_config32(dev, DRAM_CONFIG_HIGH, reg); pci_write_config32(dev, DRAM_CONFIG_HIGH, reg);
} }
#endif
#if CONFIG_MEM_TRAIN_SEQ == 0 #if CONFIG_MEM_TRAIN_SEQ == 0
#if K8_REV_F_SUPPORT_F0_F1_WORKAROUND == 1 #if K8_REV_F_SUPPORT_F0_F1_WORKAROUND == 1
@ -1998,7 +1981,9 @@ static void dqs_timing(int controllers, const struct mem_controller *ctrl, struc
if(train_DqsRcvrEn(ctrl+i, 2, sysinfo)) goto out; if(train_DqsRcvrEn(ctrl+i, 2, sysinfo)) goto out;
printk(BIOS_DEBUG, " done\n"); printk(BIOS_DEBUG, " done\n");
sysinfo->mem_trained[i]=1; sysinfo->mem_trained[i]=1;
#if CONFIG_HAVE_ACPI_RESUME == 1
dqs_save_MC_NVRAM((ctrl+i)->f2); dqs_save_MC_NVRAM((ctrl+i)->f2);
#endif
} }
out: out:

View File

@ -31,6 +31,7 @@
/* The 256 bytes of NVRAM for S3 storage, 256B aligned */ /* The 256 bytes of NVRAM for S3 storage, 256B aligned */
#define K8T890_NVRAM_IO_BASE 0xf00 #define K8T890_NVRAM_IO_BASE 0xf00
#define K8T890_NVRAM_CBMEM_TOC 0xfc
#define K8T890_MMCONFIG_MBAR 0x61 #define K8T890_MMCONFIG_MBAR 0x61
#define K8T890_MULTIPLE_FN_EN 0x4f #define K8T890_MULTIPLE_FN_EN 0x4f

View File

@ -23,16 +23,14 @@
*/ */
#include <stdlib.h> #include <stdlib.h>
#include <cbmem.h>
#include <arch/io.h>
#include "k8t890.h" #include "k8t890.h"
/* The 256 bytes of NVRAM for S3 storage, 256B aligned */ /* The 256 bytes of NVRAM for S3 storage, 256B aligned */
#define K8T890_NVRAM_IO_BASE 0xf00 #define K8T890_NVRAM_IO_BASE 0xf00
#define K8T890_MULTIPLE_FN_EN 0x4f #define K8T890_MULTIPLE_FN_EN 0x4f
/* we provide S3 NVRAM to system */
#define S3_NVRAM_EARLY 1
/* AMD K8 LDT0, LDT1, LDT2 Link Control Registers */ /* AMD K8 LDT0, LDT1, LDT2 Link Control Registers */
static u8 ldtreg[3] = {0x86, 0xa6, 0xc6}; static u8 ldtreg[3] = {0x86, 0xa6, 0xc6};
@ -155,3 +153,9 @@ static inline int s3_load_nvram_early(int size, u32 *old_dword, int nvram_pos)
printk(BIOS_DEBUG, "Loading %x of size %d to nvram pos:%d\n", * old_dword, size, nvram_pos-size); printk(BIOS_DEBUG, "Loading %x of size %d to nvram pos:%d\n", * old_dword, size, nvram_pos-size);
return nvram_pos; return nvram_pos;
} }
/* this should be a function
struct cbmem_entry *get_cbmem_toc(void) {
*/
#define get_cbmem_toc() ((struct cbmem_entry *) inl(K8T890_NVRAM_IO_BASE+K8T890_NVRAM_CBMEM_TOC))

View File

@ -22,6 +22,8 @@
#include <device/pci_ops.h> #include <device/pci_ops.h>
#include <device/pci_ids.h> #include <device/pci_ids.h>
#include <console/console.h> #include <console/console.h>
#include <cbmem.h>
#include <arch/io.h>
#include "k8t890.h" #include "k8t890.h"
/* this may be later merged */ /* this may be later merged */
@ -111,6 +113,14 @@ static void host_ctrl_enable_k8m890(struct device *dev) {
pci_write_config8(dev, 0xa6, 0x83); pci_write_config8(dev, 0xa6, 0x83);
} }
#if 0
struct cbmem_entry *get_cbmem_toc(void) {
return (struct cbmem_entry *) inl(K8T890_NVRAM_IO_BASE+K8T890_NVRAM_CBMEM_TOC);
}
#endif
void set_cbmem_toc(struct cbmem_entry *toc) {
outl((u32) toc, K8T890_NVRAM_IO_BASE+K8T890_NVRAM_CBMEM_TOC);
}
static const struct device_operations host_ctrl_ops_t = { static const struct device_operations host_ctrl_ops_t = {
.read_resources = pci_dev_read_resources, .read_resources = pci_dev_read_resources,

View File

@ -316,9 +316,7 @@ void enable_rom_decode(void)
pci_write_config8(dev, 0x41, 0x7f); pci_write_config8(dev, 0x41, 0x7f);
} }
#ifdef CONFIG_NORTHBRIDGE_AMD_K8 /* CN700 doesn't have the support yet */ #if CONFIG_HAVE_ACPI_RESUME == 1
#define ACPI_IS_WAKEUP_EARLY 1
static int acpi_is_wakeup_early(void) { static int acpi_is_wakeup_early(void) {
device_t dev; device_t dev;
u16 tmp; u16 tmp;