00001 /* 00002 * Copyright (C) 2006 Ondrej Palkovsky 00003 * All rights reserved. 00004 * 00005 * Redistribution and use in source and binary forms, with or without 00006 * modification, are permitted provided that the following conditions 00007 * are met: 00008 * 00009 * - Redistributions of source code must retain the above copyright 00010 * notice, this list of conditions and the following disclaimer. 00011 * - Redistributions in binary form must reproduce the above copyright 00012 * notice, this list of conditions and the following disclaimer in the 00013 * documentation and/or other materials provided with the distribution. 00014 * - The name of the author may not be used to endorse or promote products 00015 * derived from this software without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 00018 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 00019 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 00020 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 00021 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 00022 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 00023 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 00024 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 00025 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 00026 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00027 */ 00028 00036 #include <arch/asm.h> 00037 #include <arch/drivers/pic.h> 00038 #include <byteorder.h> 00039 #include <bitops.h> 00040 00041 static volatile __u32 *pic; 00042 00043 void pic_init(void) 00044 { 00045 pic = (__u32 *)hw_map(PIC_HW_ADDR, PAGE_SIZE); 00046 } 00047 00048 00049 00050 void pic_enable_interrupt(int intnum) 00051 { 00052 if (intnum < 32) { 00053 pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] | (1 << intnum); 00054 } else { 00055 pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] | (1 << (intnum - 32)); 00056 } 00057 00058 } 00059 00060 void pic_disable_interrupt(int intnum) 00061 { 00062 if (intnum < 32) { 00063 pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum)); 00064 } else { 00065 pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32))); 00066 } 00067 } 00068 00069 void pic_ack_interrupt(int intnum) 00070 { 00071 if (intnum < 32) 00072 pic[PIC_ACK_LOW] = 1 << intnum; 00073 else 00074 pic[PIC_ACK_HIGH] = 1 << (intnum - 32); 00075 } 00076 00078 int pic_get_pending(void) 00079 { 00080 int pending; 00081 00082 pending = pic[PIC_PENDING_LOW]; 00083 if (pending) { 00084 return fnzb32(pending); 00085 } 00086 pending = pic[PIC_PENDING_HIGH]; 00087 if (pending) { 00088 return fnzb32(pending) + 32; 00089 } 00090 return -1; 00091 } 00092