navienginebsp/naviengine_assp/uart/uart16550_ne.cia
changeset 0 5de814552237
equal deleted inserted replaced
-1:000000000000 0:5de814552237
       
     1 /*
       
     2 * Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies).
       
     3 * All rights reserved.
       
     4 * This component and the accompanying materials are made available
       
     5 * under the terms of "Eclipse Public License v1.0"
       
     6 * which accompanies this distribution, and is available
       
     7 * at the URL "http://www.eclipse.org/legal/epl-v10.html".
       
     8 *
       
     9 * Initial Contributors:
       
    10 * Nokia Corporation - initial contribution.
       
    11 *
       
    12 * Contributors:
       
    13 *
       
    14 * Description:  
       
    15 * naviengine_assp\uart\uart16550.cia
       
    16 * PDD for 16550 UART - ARM assembler bits
       
    17 *
       
    18 */
       
    19 
       
    20 
       
    21 
       
    22 #include <comm.h>
       
    23 #include <assp.h>
       
    24 #include "uart16550_ne.h"
       
    25 #include <e32hal.h>
       
    26 
       
    27 __NAKED__ void T16550Uart::ModifyFCR(TUint /*aClearMask*/, TUint /*aSetMask*/)
       
    28 	{
       
    29 	asm("mrs ip, cpsr ");
       
    30 	asm("orr r3, ip, #0xc0 ");
       
    31 	asm("msr cpsr, r3 ");
       
    32 	asm("ldrb r3, [r0, #4] ");
       
    33 	asm("bic r3, r3, r1 ");
       
    34 	asm("ldr r1, [r0, #0] ");
       
    35 	asm("orr r3, r3, r2 ");
       
    36 	asm("strb r3, [r0, #4] ");
       
    37 	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550FCROffset));
       
    38 	asm("msr cpsr, ip ");
       
    39 	__JUMP(,lr);
       
    40 	}
       
    41 
       
    42 __NAKED__ void T16550Uart::ModifyLCR(TUint /*aClearMask*/, TUint /*aSetMask*/)
       
    43 	{
       
    44 	asm("mrs ip, cpsr ");
       
    45 	asm("orr r3, ip, #0xc0 ");
       
    46 	asm("msr cpsr, r3 ");
       
    47 	asm("ldrb r3, [r0, #5] ");
       
    48 	asm("bic r3, r3, r1 ");
       
    49 	asm("ldr r1, [r0, #0] ");
       
    50 	asm("orr r3, r3, r2 ");
       
    51 	asm("strb r3, [r0, #5] ");
       
    52 	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550LCROffset));
       
    53 	asm("msr cpsr, ip ");
       
    54 	__JUMP(,lr);
       
    55 	}
       
    56 
       
    57 __NAKED__ void T16550Uart::ModifyMCR(TUint /*aClearMask*/, TUint /*aSetMask*/)
       
    58 	{
       
    59 	asm("mrs ip, cpsr ");
       
    60 	asm("orr r3, ip, #0xc0 ");
       
    61 	asm("msr cpsr, r3 ");
       
    62 	asm("ldrb r3, [r0, #6] ");
       
    63 	asm("bic r3, r3, r1 ");
       
    64 	asm("ldr r1, [r0, #0] ");
       
    65 	asm("orr r3, r3, r2 ");
       
    66 	asm("strb r3, [r0, #6] ");
       
    67 	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550MCROffset));
       
    68 	asm("msr cpsr, ip ");
       
    69 	__JUMP(,lr);
       
    70 	}
       
    71 
       
    72 __NAKED__ void T16550Uart::ModifyIER(TUint /*aClearMask*/, TUint /*aSetMask*/)
       
    73 	{
       
    74 	asm("mrs ip, cpsr ");
       
    75 	asm("orr r3, ip, #0xc0 ");
       
    76 	asm("msr cpsr, r3 ");
       
    77 	asm("ldrb r3, [r0, #7] ");
       
    78 	asm("bic r3, r3, r1 ");
       
    79 	asm("ldr r1, [r0, #0] ");
       
    80 	asm("orr r3, r3, r2 ");
       
    81 	asm("strb r3, [r0, #7] ");
       
    82 	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550IEROffset));
       
    83 	asm("msr cpsr, ip ");
       
    84 	__JUMP(,lr);
       
    85 	}
       
    86 
       
    87 __NAKED__ void T16550Uart::SetFCR(TUint /*aValue*/)
       
    88 	{
       
    89 	asm("mrs ip, cpsr ");
       
    90 	asm("ldr r3, [r0, #0] ");
       
    91 	asm("orr r2, ip, #0xc0 ");
       
    92 	asm("msr cpsr, r2 ");
       
    93 	asm("strb r1, [r0, #4] ");
       
    94 	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550FCROffset));
       
    95 	asm("msr cpsr, ip ");
       
    96 	__JUMP(,lr);
       
    97 	}
       
    98 
       
    99 __NAKED__ void T16550Uart::SetLCR(TUint /*aValue*/)
       
   100 	{
       
   101 	asm("mrs ip, cpsr ");
       
   102 	asm("ldr r3, [r0, #0] ");
       
   103 	asm("orr r2, ip, #0xc0 ");
       
   104 	asm("msr cpsr, r2 ");
       
   105 	asm("strb r1, [r0, #5] ");
       
   106 	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550LCROffset));
       
   107 	asm("msr cpsr, ip ");
       
   108 	__JUMP(,lr);
       
   109 	}
       
   110 
       
   111 __NAKED__ void T16550Uart::SetMCR(TUint /*aValue*/)
       
   112 	{
       
   113 	asm("mrs ip, cpsr ");
       
   114 	asm("ldr r3, [r0, #0] ");
       
   115 	asm("orr r2, ip, #0xc0 ");
       
   116 	asm("msr cpsr, r2 ");
       
   117 	asm("strb r1, [r0, #6] ");
       
   118 	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550MCROffset));
       
   119 	asm("msr cpsr, ip ");
       
   120 	__JUMP(,lr);
       
   121 	}
       
   122 
       
   123 __NAKED__ void T16550Uart::SetIER(TUint /*aValue*/)
       
   124 	{
       
   125 	asm("mrs ip, cpsr ");
       
   126 	asm("ldr r3, [r0, #0] ");
       
   127 	asm("orr r2, ip, #0xc0 ");
       
   128 	asm("msr cpsr, r2 ");
       
   129 	asm("strb r1, [r0, #7] ");
       
   130 	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550IEROffset));
       
   131 	asm("msr cpsr, ip ");
       
   132 	__JUMP(,lr);
       
   133 	}