Rev 3343 | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 3343 | Rev 3665 | ||
---|---|---|---|
Line 1... | Line 1... | ||
1 | /* |
1 | /* |
2 | * Copyright (c) 2006 Jakub Jermar |
2 | * Copyright (c) 2006 Jakub Jermar, Jakub vana |
3 | * All rights reserved. |
3 | * All rights reserved. |
4 | * |
4 | * |
5 | * Redistribution and use in source and binary forms, with or without |
5 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions |
6 | * modification, are permitted provided that the following conditions |
7 | * are met: |
7 | * are met: |
Line 33... | Line 33... | ||
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <ddi/ddi.h> |
35 | #include <ddi/ddi.h> |
36 | #include <proc/task.h> |
36 | #include <proc/task.h> |
37 | #include <arch/types.h> |
37 | #include <arch/types.h> |
- | 38 | #include <mm/slab.h> |
|
- | 39 | #include <errno.h> |
|
- | 40 | ||
- | 41 | #define IO_MEMMAP_PAGES 16384 |
|
- | 42 | #define PORTS_PER_PAGE 4 |
|
38 | 43 | ||
39 | /** Enable I/O space range for task. |
44 | /** Enable I/O space range for task. |
40 | * |
45 | * |
41 | * Interrupts are disabled and task is locked. |
46 | * Interrupts are disabled and task is locked. |
42 | * |
47 | * |
Line 46... | Line 51... | ||
46 | * |
51 | * |
47 | * @return 0 on success or an error code from errno.h. |
52 | * @return 0 on success or an error code from errno.h. |
48 | */ |
53 | */ |
49 | int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size) |
54 | int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size) |
50 | { |
55 | { |
- | 56 | ||
- | 57 | if(!task->arch.iomap) |
|
- | 58 | { |
|
- | 59 | uint8_t *map; |
|
- | 60 | task->arch.iomap=malloc(sizeof(bitmap_t),0); |
|
- | 61 | map=malloc(BITS2BYTES(IO_MEMMAP_PAGES),0); |
|
- | 62 | if(!map) |
|
- | 63 | return ENOMEM; |
|
- | 64 | bitmap_initialize(task->arch.iomap,map,IO_MEMMAP_PAGES); |
|
- | 65 | bitmap_clear_range(task->arch.iomap,0,IO_MEMMAP_PAGES); |
|
- | 66 | } |
|
- | 67 | ||
- | 68 | uintptr_t iopage = ioaddr / PORTS_PER_PAGE; |
|
- | 69 | size = ALIGN_UP (size+ioaddr-4*iopage,PORTS_PER_PAGE); |
|
- | 70 | bitmap_set_range(task->arch.iomap,iopage,size/4); |
|
- | 71 | ||
- | 72 | ||
51 | return 0; |
73 | return 0; |
52 | } |
74 | } |
53 | 75 | ||
54 | /** @} |
76 | /** @} |
55 | */ |
77 | */ |