arch/x86/cpu/sc520/sc520_ssi.c

   1 /*
   2  * (C) Copyright 2002
   3  * Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25 #include <asm/io.h>
  26 #include <asm/arch/ssi.h>
  27 #include <asm/arch/sc520.h>
  28
  29 int ssi_set_interface(int freq, int lsb_first, int inv_clock, int inv_phase)
  30 {
  31         u8 temp = 0;
  32
  33         if (freq >= 8192)
  34                 temp |= CTL_CLK_SEL_4;
  35         else if (freq >= 4096)
  36                 temp |= CTL_CLK_SEL_8;
  37         else if (freq >= 2048)
  38                 temp |= CTL_CLK_SEL_16;
  39         else if (freq >= 1024)
  40                 temp |= CTL_CLK_SEL_32;
  41         else if (freq >= 512)
  42                 temp |= CTL_CLK_SEL_64;
  43         else if (freq >= 256)
  44                 temp |= CTL_CLK_SEL_128;
  45         else if (freq >= 128)
  46                 temp |= CTL_CLK_SEL_256;
  47         else
  48                 temp |= CTL_CLK_SEL_512;
  49
  50         if (!lsb_first)
  51                 temp |= MSBF_ENB;
  52
  53         if (inv_clock)
  54                 temp |= CLK_INV_ENB;
  55
  56         if (inv_phase)
  57                 temp |= PHS_INV_ENB;
  58
  59         writeb(temp, &sc520_mmcr->ssictl);
  60
  61         return 0;
  62 }
  63
  64 u8 ssi_txrx_byte(u8 data)
  65 {
  66         writeb(data, &sc520_mmcr->ssixmit);
  67         while (readb(&sc520_mmcr->ssista) & SSISTA_BSY)
  68                 ;
  69         writeb(SSICMD_CMD_SEL_XMITRCV, &sc520_mmcr->ssicmd);
  70         while (readb(&sc520_mmcr->ssista) & SSISTA_BSY)
  71                 ;
  72
  73         return readb(&sc520_mmcr->ssircv);
  74 }
  75
  76 void ssi_tx_byte(u8 data)
  77 {
  78         writeb(data, &sc520_mmcr->ssixmit);
  79         while (readb(&sc520_mmcr->ssista) & SSISTA_BSY)
  80                 ;
  81         writeb(SSICMD_CMD_SEL_XMIT, &sc520_mmcr->ssicmd);
  82 }
  83
  84 u8 ssi_rx_byte(void)
  85 {
  86         while (readb(&sc520_mmcr->ssista) & SSISTA_BSY)
  87                 ;
  88         writeb(SSICMD_CMD_SEL_RCV, &sc520_mmcr->ssicmd);
  89         while (readb(&sc520_mmcr->ssista) & SSISTA_BSY)
  90                 ;
  91
  92         return readb(&sc520_mmcr->ssircv);
  93 }