Rev 1047 |
Go to most recent revision |
Blame |
Compare with Previous |
Last modification |
View Log
| RSS feed
#include <ll/i386/hw-instr.h>
#include <ll/i386/cons.h>
#include <ll/sys/ll/time.h>
#include <linuxcomp.h>
#include <linux/time.h>
#include <linux/sched.h>
#include <linux/ioport.h>
#include <linux/errno.h>
#include <asm/io.h>
#include <linux/ctype.h>
#include <linux/device.h>
#include <linux/completion.h>
#include <linux/tty.h>
#include <asm/setup.h>
#define memory_barrier __asm__("" ::: "memory")
extern unsigned long intr_count
;
extern int activeInt
;
unsigned char _ctype
[] = {
_C
,_C
,_C
,_C
,_C
,_C
,_C
,_C
, /* 0-7 */
_C
,_C
|_S
,_C
|_S
,_C
|_S
,_C
|_S
,_C
|_S
,_C
,_C
, /* 8-15 */
_C
,_C
,_C
,_C
,_C
,_C
,_C
,_C
, /* 16-23 */
_C
,_C
,_C
,_C
,_C
,_C
,_C
,_C
, /* 24-31 */
_S
|_SP
,_P
,_P
,_P
,_P
,_P
,_P
,_P
, /* 32-39 */
_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
, /* 40-47 */
_D
,_D
,_D
,_D
,_D
,_D
,_D
,_D
, /* 48-55 */
_D
,_D
,_P
,_P
,_P
,_P
,_P
,_P
, /* 56-63 */
_P
,_U
|_X
,_U
|_X
,_U
|_X
,_U
|_X
,_U
|_X
,_U
|_X
,_U
, /* 64-71 */
_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
, /* 72-79 */
_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
, /* 80-87 */
_U
,_U
,_U
,_P
,_P
,_P
,_P
,_P
, /* 88-95 */
_P
,_L
|_X
,_L
|_X
,_L
|_X
,_L
|_X
,_L
|_X
,_L
|_X
,_L
, /* 96-103 */
_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
, /* 104-111 */
_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
, /* 112-119 */
_L
,_L
,_L
,_P
,_P
,_P
,_P
,_C
, /* 120-127 */
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 128-143 */
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 144-159 */
_S
|_SP
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
, /* 160-175 */
_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
,_P
, /* 176-191 */
_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_U
, /* 192-207 */
_U
,_U
,_U
,_U
,_U
,_U
,_U
,_P
,_U
,_U
,_U
,_U
,_U
,_U
,_U
,_L
, /* 208-223 */
_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
, /* 224-239 */
_L
,_L
,_L
,_L
,_L
,_L
,_L
,_P
,_L
,_L
,_L
,_L
,_L
,_L
,_L
,_L
}; /* 240-255 */
__kernel_size_t strnlen
(const char *s
, __kernel_size_t count
)
{
const char *sc
;
for (sc
= s
; count
-- && *sc
!= '\0'; ++sc
)
/* nothing */;
return sc
- s
;
}
int nanosleep
(const struct timespec
*rqtp
, struct timespec
*rmtp
);
struct resource ioport_resource
= {
.
name = "PCI IO",
.
start = 0x0000,
.
end = IO_SPACE_LIMIT
,
.
flags = IORESOURCE_IO
,
};
struct resource iomem_resource
= {
.
name = "PCI mem",
.
start = 0UL
,
.
end = ~0UL
,
.
flags = IORESOURCE_MEM
,
};
/* Return the conflict entry if you can't request it */
static struct resource
* __request_resource
(struct resource
*root
, struct resource
*new
)
{
unsigned long start
= new
->start
;
unsigned long end
= new
->end
;
struct resource
*tmp
, **p
;
if (end
< start
)
return root
;
if (start
< root
->start
)
return root
;
if (end
> root
->end
)
return root
;
p
= &root
->child
;
for (;;) {
tmp
= *p
;
if (!tmp
|| tmp
->start
> end
) {
new
->sibling
= tmp
;
*p
= new
;
new
->parent
= root
;
return NULL
;
}
p
= &tmp
->sibling
;
if (tmp
->end
< start
)
continue;
return tmp
;
}
}
static int __release_resource
(struct resource
*old
)
{
struct resource
*tmp
, **p
;
p
= &old
->parent
->child
;
for (;;) {
tmp
= *p
;
if (!tmp
)
break;
if (tmp
== old
) {
*p
= tmp
->sibling
;
old
->parent
= NULL
;
return 0;
}
p
= &tmp
->sibling
;
}
return -EINVAL
;
}
int release_resource
(struct resource
*old
)
{
int retval
;
retval
= __release_resource
(old
);
return retval
;
}
int request_resource
(struct resource
*root
, struct resource
*new
)
{
struct resource
*conflict
;
conflict
= __request_resource
(root
, new
);
return conflict
? -EBUSY
: 0;
}
struct resource
* __request_region
(struct resource
*parent
, unsigned long start
, unsigned long n
, const char *name
)
{
return (void *)(0xFFFFFFFF);
}
void __release_region
(struct resource
*parent
, unsigned long start
, unsigned long n
)
{
}
static int find_resource
(struct resource
*root
, struct resource
*new
,
unsigned long size
,
unsigned long min
, unsigned long max
,
unsigned long align
,
void (*alignf
)(void *, struct resource
*,
unsigned long, unsigned long),
void *alignf_data
)
{
struct resource
*this
= root
->child
;
new
->start
= root
->start
;
/*
* Skip past an allocated resource that starts at 0, since the assignment
* of this->start - 1 to new->end below would cause an underflow.
*/
if (this
&& this
->start
== 0) {
new
->start
= this
->end
+ 1;
this
= this
->sibling
;
}
for(;;) {
if (this
)
new
->end
= this
->start
- 1;
else
new
->end
= root
->end
;
if (new
->start
< min
)
new
->start
= min
;
if (new
->end
> max
)
new
->end
= max
;
new
->start
= (new
->start
+ align
- 1) & ~
(align
- 1);
if (alignf
)
alignf
(alignf_data
, new
, size
, align
);
if (new
->start
< new
->end
&& new
->end
- new
->start
+ 1 >= size
) {
new
->end
= new
->start
+ size
- 1;
return 0;
}
if (!this
)
break;
new
->start
= this
->end
+ 1;
this
= this
->sibling
;
}
return -EBUSY
;
}
int allocate_resource
(struct resource
*root
, struct resource
*new
,
unsigned long size
,
unsigned long min
, unsigned long max
,
unsigned long align
,
void (*alignf
)(void *, struct resource
*,
unsigned long, unsigned long),
void *alignf_data
)
{
int err
;
err
= find_resource
(root
, new
, size
, min
, max
, align
, alignf
, alignf_data
);
if (err
>= 0 && __request_resource
(root
, new
))
err
= -EBUSY
;
return err
;
}
int remap_page_range
(struct vm_area_struct
*vma
, unsigned long from
, unsigned long phys_addr
, unsigned long size
, pgprot_t prot
)
{
return 0;
}
void dump_stack
(void)
{
}
void panic
(const char * fmt
, ...
)
{
cprintf
((char *)(fmt
));
}
extern void * malloc(size_t size
);
void *__kmalloc
(size_t size
, int flags
)
{
return malloc(size
);
}
extern void free(void *);
void kfree
(const void *ptr
)
{
free((void *)(ptr
));
}
unsigned long pci_mem_start
= 0x10000000;
// added __attribute__ for gcc4 compatibility
__attribute__
((regparm
(3))) signed long schedule_timeout
(signed long timeout
)
{
struct timespec t
,s
,e
;
jiffies_to_timespec
(timeout
, &t
);
if (!activeInt
&& !intr_count
) {
nanosleep
(&t
,NULL
);
} else {
ll_gettime
(TIME_NEW
,&s
);
ADDTIMESPEC
(&t
,&s
,&e
);
memory_barrier
;
while(TIMESPEC_A_LT_B
(&s
,&e
)) {
memory_barrier
;
ll_gettime
(TIME_NEW
,&s
);
}
}
return 0;
}
void __const_udelay
(unsigned long usecs
)
{
struct timespec t
,s
,e
;
if (!activeInt
&& !intr_count
) {
t.
tv_sec = 0;
t.
tv_nsec = usecs
* 1000;
nanosleep
(&t
,NULL
);
} else {
ll_gettime
(TIME_NEW
,&e
);
ADDUSEC2TIMESPEC
(usecs
,&e
);
memory_barrier
;
ll_gettime
(TIME_NEW
,&s
);
while(TIMESPEC_A_LT_B
(&s
,&e
)) {
memory_barrier
;
ll_gettime
(TIME_NEW
,&s
);
}
}
}
void * vmalloc_32
(size_t size
);
void *dma_alloc_coherent
(struct device
*dev
, size_t size
, dma_addr_t
*dma_handle
, int gfp
)
{
void *ret
;
/* ignore region specifiers */
gfp
&= ~
(__GFP_DMA
| __GFP_HIGHMEM
);
if (dev
== NULL
|| (*dev
->dma_mask
< 0xffffffff))
gfp
|= GFP_DMA
;
ret
= (void *)vmalloc_32
(size
);
if (ret
!= NULL
) {
memset(ret
, 0, size
);
*dma_handle
= (dma_addr_t
)ret
;
}
return ret
;
}
void *dma_alloc_coherent_usb
(struct device
*dev
, size_t size
, dma_addr_t
*dma_handle
, int gfp
)
{
void *ret
;
/* ignore region specifiers */
gfp
&= ~
(__GFP_DMA
| __GFP_HIGHMEM
);
if (dev
== NULL
|| (*dev
->dma_mask
< 0xffffffff))
gfp
|= GFP_DMA
;
ret
= (void *)vmalloc_32_usb
(size
);
if (ret
!= NULL
) {
memset(ret
, 0, size
);
*dma_handle
= (dma_addr_t
)ret
;
}
return ret
;
}
void dma_free_coherent
(struct device
*dev
, size_t size
, void *vaddr
, dma_addr_t dma_handle
)
{
vfree
((void *)dma_handle
);
}
extern void __wake_up_common
(wait_queue_head_t
*q
, unsigned int mode
, int nr_exclusive
, int sync
);
void init_completion
(struct completion
*x
) {
x
->done
= 0;
init_waitqueue_head
(&x
->wait
);
}
// added __attribute__ for gcc4 compatibility
__attribute__
((regparm
(3))) void complete
(struct completion
*x
)
{
x
->done
++;
__wake_up_common
(&x
->wait
, TASK_UNINTERRUPTIBLE
| TASK_INTERRUPTIBLE
, 1, 0);
}
// added __attribute__ for gcc4 compatibility
__attribute__
((regparm
(3))) void wait_for_completion
(struct completion
*x
)
{
spin_lock_irq
(&x
->wait.
lock);
if (!x
->done
) {
DECLARE_WAITQUEUE
(wait
, current
);
wait.
flags |= WQ_FLAG_EXCLUSIVE
;
__add_wait_queue_tail
(&x
->wait
, &wait
);
do {
__set_current_state
(TASK_UNINTERRUPTIBLE
);
spin_unlock_irq
(&x
->wait.
lock);
schedule
();
spin_lock_irq
(&x
->wait.
lock);
} while (!x
->done
);
__remove_wait_queue
(&x
->wait
, &wait
);
}
x
->done
--;
spin_unlock_irq
(&x
->wait.
lock);
}
struct device legacy_bus
= {
.
bus_id = "legacy",
};
int register_chrdev
(unsigned int a
, const char *b
, struct file_operations
*c
)
{
return 0;
}
int unregister_chrdev
(unsigned int a
, const char *b
)
{
return 0;
}
void * __ioremap
(unsigned long offset
, unsigned long size
, unsigned long flags
)
{
return (void *)offset
;
}
void iounmap
(void *addr
)
{
}
loff_t no_llseek
(struct file
*file
, loff_t offset
, int origin
)
{
return 0;
}
void *vmalloc
(unsigned long size
)
{
return malloc(size
);
}
void *kern_alloc_aligned
(size_t size
, DWORD flags
, int align_bits
, DWORD align_ofs
);
void * vmalloc_32
(size_t size
)
{
void *mem
;
unsigned long diff
;
mem
= malloc(size
+12);
diff
= (unsigned long)((((unsigned long)mem
/4)+1)*4-(unsigned long)mem
);
*(unsigned long *)(mem
+diff
) = (diff
| 0x80000000);
return (mem
+diff
+4);
}
void vfree
(void *addr
)
{
if (addr
== NULL
|| *(unsigned long *)(addr
-4) == 0)
return;
if ((*(unsigned long *)(addr
-4) & 0x80000000) == 0x80000000) {
free(addr
-(*(unsigned long *)(addr
-4) & 0x7FFFFFFF)-4);
*(unsigned long *)(addr
-4) = 0;
return;
}
free(addr
);
return;
}
void * vmalloc_32_usb
(size_t size
)
{
void* mem
;
unsigned long diff
;
mem
= malloc( size
+ 2 * 4096 );
if (! mem
)
return NULL
;
diff
= 4096 - (((unsigned long) mem
) % 4096);
*(unsigned long *)(mem
+diff
) = (diff
| 0x80000000);
return (void*)(mem
+ diff
+ 4096);
}
/* TODO */
char * strsep
(char **a
,const char *b
)
{
return NULL
;
}
struct screen_info screen_info
;
int linuxcomp_setfd
(struct inode
*i
, int i_rdev
)
{
i
->i_rdev
= i_rdev
;
return 0;
}
int linuxcomp_init
(void)
{
return 0;
}
struct page
*mem_map
= 0x0000;
// added __attribute__ for gcc4 compatibility
__attribute__
((regparm
(3))) int schedule_work
(struct work_struct
*work
)
{
return 0;
}
int allow_signal
(int sig
)
{
return 0;
}
void flush_scheduled_work
(void) { }
void daemonize
(const char *name
, ...
) { }
void yield
(void) { }
void do_exit
(long code
) { }
void complete_and_exit
(struct completion
*comp
, long code
)
{
if (comp
)
complete
(comp
);
do_exit
(code
);
}
inline void * ioremap_nocache
(unsigned long offset
, unsigned long size
)
{
return __ioremap
(offset
, size
, 0);
}
#define NULL_TIMESPEC(t) ((t)->tv_sec = (t)->tv_nsec = 0)
int wait_ms26
(unsigned long msec
)
{
struct timespec t1
, t2
;
int nsec
;
t1.
tv_sec = msec
/1000;
nsec
= (msec
% 1000) * 1000000;
t1.
tv_nsec = nsec
;
NULL_TIMESPEC
(&t2
);
nanosleep
(&t1
, &t2
);
return 0;
}