[Gc-linux-cvs] linux/arch/ppc/platforms gamecube_time.c,NONE,1.1

[<sve...@us...>]

Update of /cvsroot/gc-linux/linux/arch/ppc/platforms
In directory sc8-pr-cvs1.sourceforge.net:/tmp/cvs-serv19046

Added Files:
	gamecube_time.c 
Log Message:
Created


--- NEW FILE: gamecube_time.c ---
/*#include <linux/config.h>
#include <linux/errno.h>
#include <linux/sched.h>
#include <linux/kernel.h>
#include <linux/param.h>
#include <linux/string.h>
*/
//#include <linux/mm.h>
#include <linux/init.h>
#include <linux/time.h>



#define RTC_OFFSET 946684800L

static int bias = 0;

long __init
gamecube_time_init(void)
{
  char sram[64];
  int *pbias = &sram[0xC];
  read_sram(sram);
  bias = *pbias;
  printk("gamecube_time_init\n");
  return 0;
}

unsigned long gamecube_get_rtc_time(void)
{
  return get_rtc() + bias + RTC_OFFSET;
}

int gamecube_set_rtc_time(unsigned long nowtime)
{
  set_rtc(nowtime - RTC_OFFSET - bias);

  return 1;
}


static unsigned long get_rtc (void)
{
   unsigned long a = 0L;

   // Select the RTC device.
   exi_select (0, 1, 3);

   // Send the appropriate command.
   a = 0x20000000;
   exi_imm (0, &a, 4, 1, 0);
   exi_sync(0);
   // Read the time and date value!
   exi_imm (0, &a, 4, 0, 0);
   exi_sync(0);

   // Deselect the RTC device.
   exi_deselect (0);

   return a;
}

static void set_rtc (unsigned long aval)
{
   unsigned long a;

   // Select the RTC device.
   exi_select (0, 1, 3);

   // Send the appropriate command.
   a = 0xA0000000;
   exi_imm (0, &a,    4, 1, 0);

   // Set the new time and date value!
   exi_imm (0, &aval, 4, 1, 0);

   // Deselect the RTC device.
   exi_deselect (0);
}

static void read_sram (unsigned char *abuf)
{
   unsigned long a;

   // Select the SRAM device.
   exi_select (0, 1, 3);

   // Send the appropriate command.
   a = 0x20000100;
   exi_imm (0, &a, 4, 1, 0);
   exi_sync(0);

   // Read the SRAM data!
   exi_imm_ex (0, abuf, 64, 0);

   // Deselect the SRAM device.
   exi_deselect (0);

   return;
}

///////////////////////////////////////////////////////////////////////////////////////////////////////
// must be MOVED LATER
///////////////////////////////////////////////////////////////////////////////////////////////////////
#define EXI_READ  0
#define EXI_WRITE 1

/* exi_select: enable chip select, set speed */

static int selected = 0;
static void exi_select(int channel, int device, int freq)
{
	volatile unsigned long *exi = (volatile unsigned long *)0xCC006800;
	selected ++;
	if (selected != 1)
		panic("-------- select while selected!\n");
	long d;
	// exi_select
	d = exi[channel * 5];
	d &= 0x405;
	d |= ((1<<device)<<7) | (freq << 4);
	exi[channel*5] = d;
}

/* disable chipselect */
static void exi_deselect(int channel)
{
	volatile unsigned long *exi = (volatile unsigned long *)0xCC006800;
	selected--;
	if (selected)
		panic("deselect broken!");
	exi[channel * 5] &= 0x405;
}

/* dirty way for asynchronous reads */
static void *exi_last_addr;
static int   exi_last_len;

/* mode?Read:Write len bytes to/from channel */
/* when read, data will be written back in exi_sync */
static void exi_imm(int channel, void *data, int len, int mode, int zero)
{
	volatile unsigned long *exi = (volatile unsigned long *)0xCC006800;
	if (mode == EXI_WRITE)
		exi[channel * 5 + 4] = *(unsigned long*)data;
	exi[channel * 5 + 3] = ((len-1)<<4)|(mode<<2)|1;
	if (mode == EXI_READ)
	{
		exi_last_addr = data;
		exi_last_len = len;
	} else
	{
		exi_last_addr = 0;
		exi_last_len = 0;
	}
}

/* Wait until transfer is done, write back data */
static void exi_sync(int channel)
{
	volatile unsigned long *exi = (volatile unsigned long *)0xCC006800;
	while (exi[channel * 5 + 3] & 1);

	if (exi_last_addr)
	{
		int i;
		unsigned long d;
		d = exi[channel * 5 + 4];
		for (i=0; i<exi_last_len; ++i)
			((unsigned char*)exi_last_addr)[i] = (d >> ((3-i)*8)) & 0xFF;
	}
}

/* simple wrapper for transfers > 4bytes */
static void exi_imm_ex(int channel, void *data, int len, int mode)
{
	unsigned char *d = (unsigned char*)data;
	while (len)
	{
		int tc = len;
		if (tc > 4) tc = 4;
		exi_imm(channel, d, tc, mode, 0);
		exi_sync(channel);
		len-=tc;
		d+=tc;
	}
}