128 lines
3.4 KiB
C
Executable File
128 lines
3.4 KiB
C
Executable File
|
|
#include "addresses.h"
|
|
#include "Sound4Calc.h"
|
|
#include "syscall.h"
|
|
|
|
#include <timer.h> // add timer's fonction
|
|
#include <display.h> // add display's fonction
|
|
#include <keyboard.h>
|
|
#include <mpu.h>
|
|
|
|
//#define DEBUG
|
|
|
|
//#define PI 3.14159265358
|
|
|
|
int main(void)
|
|
{
|
|
//unsigned int key=0;
|
|
|
|
int sleep = 200;
|
|
//unsigned int i=0,j=0;
|
|
|
|
setup();
|
|
|
|
while(1)
|
|
{
|
|
//dclear();
|
|
|
|
dprint(1, 1, "%d", sleep);
|
|
|
|
// PrintMini(1, 1, itoa(sleep, str, 10), 0);
|
|
dprint(1, 10, "%d", !isSH3());
|
|
|
|
//PrintMini(1, 10, itoa(is_SH4, str, 10), 0);
|
|
// dupdate();
|
|
|
|
switch(getkey())
|
|
{
|
|
case KEY_RIGHT : sleep+=5; break;
|
|
case KEY_LEFT : sleep-=5; break;
|
|
case KEY_EXE :
|
|
while(Keyboard_KeyDown())
|
|
{
|
|
|
|
ResetPin();
|
|
timer_start(TIMER_USER, sleep, Clock_Hz, SetPin, 1000);
|
|
|
|
}
|
|
//timer_stop(1);
|
|
break;
|
|
case KEY_EXIT :
|
|
return 1;
|
|
}
|
|
}
|
|
return 1; // this point is never reached
|
|
}
|
|
|
|
void setup()
|
|
{
|
|
|
|
if(isSH3())
|
|
{
|
|
// SCIF2 clock on (STBCR3.MSTP31)
|
|
*(volatile unsigned char*)SH7337_STBCR3 &= ~0x02;
|
|
// switch off SCSMR_2.TE and SCSMR_2.RE
|
|
*(volatile unsigned short*)SH7337_SCSCR2 &= ~0x0030;
|
|
// SCIF2 clock off (STBCR3.MSTP31)
|
|
*(volatile unsigned char*)SH7337_STBCR3 |= 0x02;
|
|
// set bit 6 of port G to output mode
|
|
*(volatile unsigned short*)SH7337_PGCR = ( *(volatile unsigned short*)SH7337_PGCR & ~0x3000 ) | 0x1000;
|
|
// set bit 5 and 6 of port G
|
|
*(volatile unsigned char*)SH7337_PGDR |= 0x60;
|
|
// set port SC bit 0 to output
|
|
*(volatile unsigned short*)SH7337_SCPCR = ( *(volatile unsigned short*)SH7337_SCPCR & ~0x0003 ) | 0x0001;
|
|
}
|
|
else
|
|
{
|
|
// SCIF2 clock on (MSTPCR0.MSTP007)
|
|
*(volatile unsigned int*)SH7305_MSTPCR0 &= ~0x00000080;
|
|
// switch off SCSMR_2.TE and SCSMR_2.RE
|
|
*(volatile unsigned short*)SH7305_SCSCR &= ~0x0030;
|
|
// SCIF2 clock off (MSTPCR0.MSTP007)
|
|
*(volatile unsigned int*)SH7305_MSTPCR0 |= 0x00000080;
|
|
|
|
// set bit 3 of port U to output mode
|
|
*(volatile unsigned short*)SH7305_PUCR = ( *(volatile unsigned short*)SH7305_PUCR & ~0x00C0 ) | 0x0040;
|
|
// set bit 4 and 5 of port U
|
|
*(volatile unsigned char*)SH7305_PUDR |= 0x0C;
|
|
|
|
// set port J bit 2 to output mode
|
|
*(volatile unsigned short*)SH7305_PJCR = ( *(volatile unsigned short*)SH7305_PJCR & ~0x0030 ) | 0x0010;
|
|
// set port J bit 3 to output mode
|
|
*(volatile unsigned short*)SH7305_PJCR = ( *(volatile unsigned short*)SH7305_PJCR & ~0x00C0 ) | 0x0040;
|
|
}
|
|
/*
|
|
// set port J bit 2 to output
|
|
*(unsigned short*)0xA4050110 = ( *(unsigned short*)0xA4050110 & ~0x0030 ) | 0x0010;
|
|
// set port J bit 3 to input
|
|
*(unsigned short*)0xA4050110 = ( *(unsigned short*)0xA4050110 & ~0x00C0 ) | 0x0080;*/
|
|
}
|
|
|
|
void SetPin()
|
|
{
|
|
if(isSH3())
|
|
{
|
|
*(volatile unsigned char*)SH7337_SCPDR |= 0x01;
|
|
|
|
}
|
|
else
|
|
{
|
|
*(volatile unsigned char*)SH7305_PJDR |= 0x04;
|
|
//*(volatile unsigned char*)SH7305_PJDR &= ~0x08;
|
|
//set pin to 0x4B
|
|
}
|
|
}
|
|
|
|
void ResetPin()
|
|
{
|
|
if(isSH3())
|
|
{
|
|
*(volatile unsigned char*)SH7337_SCPDR &= ~0x01;
|
|
}
|
|
else
|
|
{
|
|
*(volatile unsigned char*)SH7305_PJDR &= ~0x04;
|
|
//*(volatile unsigned char*)SH7305_PJDR |= 0x08;
|
|
// set the pin to 0x47
|
|
}
|
|
} |