linux/arch/frv/lib/insl_ns.S
<<
>>
Prefs
   1/* insl_ns.S: input array of 4b words from device port without byte swapping
   2 *
   3 * Copyright (C) 2003 Red Hat, Inc. All Rights Reserved.
   4 * Written by David Howells (dhowells@redhat.com)
   5 *
   6 * This program is free software; you can redistribute it and/or
   7 * modify it under the terms of the GNU General Public License
   8 * as published by the Free Software Foundation; either version
   9 * 2 of the License, or (at your option) any later version.
  10 */
  11
  12
  13        .text
  14        .p2align        4
  15
  16###############################################################################
  17#
  18# void __insl_ns(unsigned int port, void *buf, int n)
  19#
  20###############################################################################
  21        .globl          __insl_ns
  22        .type           __insl_ns,@function
  23__insl_ns:
  24        andicc.p        gr9,#3,gr0,icc0
  25        setlos          #4,gr4
  26        bne             icc0,#0,__insl_ns_misaligned
  27        subi            gr9,#4,gr9
  280:
  29        ldi.p           @(gr8,#0),gr5
  30        subicc          gr10,#1,gr10,icc0
  31        stu.p           gr5,@(gr9,gr4)
  32        bhi             icc0,#2,0b
  33        bralr
  34
  35__insl_ns_misaligned:
  36        subi.p          gr9,#1,gr9
  37        setlos          #1,gr4
  380:
  39        ldi             @(gr8,#0),gr5
  40
  41        srli            gr5,#24,gr6
  42        stbu.p          gr6,@(gr9,gr4)
  43        srli            gr5,#16,gr6
  44        stbu.p          gr6,@(gr9,gr4)
  45        srli            gr5,#8,gr6
  46        stbu.p          gr6,@(gr9,gr4)
  47        subicc          gr10,#1,gr10,icc0
  48        stbu.p          gr5,@(gr9,gr4)
  49        bhi             icc0,#2,0b
  50        bralr
  51
  52        .size           __insl_ns, .-__insl_ns
  53