;/* RH850 CC-RH */
.section ".text", text
.public _swi_ctx ;/*実行コンテキストの切替*/
.public _sta_ctx ;/*コンテキストをロードし、タスクを開始*/
;/************************************************
; コンテキストをロードし、タスクを開始
; void sta_ctx(
; void *exe ) //実行コンテキストの保存先
;************************************************/
_sta_ctx:
push lp
ld.w [r6],sp ;/*スタックポインタ設定*/
popsp r20,r31
jmp [lp]
;/************************************************
; 実行コンテキストの切替
; void swi_ctx(
; void *pre, //現在のコンテキストの保存先
; void *post) //切り替えるコンテキスト
;************************************************/
_swi_ctx:
pushsp r20,r31
st.w sp,[r6] ;/*スタックポインタ保存*/
ld.w [r7],sp ;/*スタックポインタ復帰*/
popsp r20,r31
jmp [lp]
/****************************************************************************/
/* タスク登録 */
/* タスクID、エントリーポイント、スタック領域、スタックサイズ、 */
/* 起動時引数を4つまで登録できる。 、 */
/****************************************************************************/
ER reg_tsk( ID tid, void *tsk, void *stk, int stk_sz,
VP_INT exinf1, VP_INT exinf2, VP_INT exinf3, VP_INT exinf4 )
{
VP_INT *ptr;
if( tid < 0 || tid >= MAX_TASK_NUMBER ) return E_ID;
/*タスクのスタックの初期化*/
tcb[tid].sp = (void *)((char *)stk + stk_sz - (4 * (12))); /*r20からr31までこの領域に保存される*/
ptr = (VP_INT *)tcb[tid].sp;
ptr[ 0] = (VP_INT)tsk; /*LP(R31)*/
ptr[ 1] = 0x30303030; /*EP(R30)*/
ptr[ 2] = 0x29292929; /*R29*/
ptr[ 3] = 0x28282828; /*R28*/
ptr[ 4] = 0x27272727; /*R27*/
ptr[ 5] = 0x26262626; /*R26*/
ptr[ 6] = 0x25252525; /*R25*/
ptr[ 7] = 0x24242424; /*R24*/
ptr[ 8] = 0x23232323; /*R23*/
ptr[ 9] = 0x22222222; /*R22*/
ptr[10] = 0x21212121; /*R21*/
ptr[11] = 0x20202020; /*R20*/
tcb[tid].exinf[0] = exinf1;
tcb[tid].exinf[1] = exinf2;
tcb[tid].exinf[2] = exinf3;
tcb[tid].exinf[3] = exinf4;
tcb[tid].rdy_flg = TTS_DMT;
return E_OK;
}
;.org #0x0000
call _main
ret
#ifndef _SFR_H_
#define _SFR_H_
__sfr __at 0x00 UART_ST;
__sfr __at 0x01 UART_TD;
__sfr __at 0x01 UART_RD;
__sfr __at 0x20 GPIO_SW;
__sfr __at 0x21 GPIO_LED;
__sfr __at 0x30 SPI1_CS;
__sfr __at 0x31 SPI1_BY;
__sfr __at 0x32 SPI1_TD;
__sfr __at 0x33 SPI1_RD;
__sfr __at 0x34 SPI1_DV;
#endif
#include "sfr_def.h"
struct sd_def
{
unsigned char cmd[8];
unsigned char res[2];
unsigned char buf[512];
} sd;
void uart_print (const char *fmt, ...);
void SD_INIT (void);
void SD_READ (int sec);
int CRC7 (unsigned char c[], int n);
void
main ()
{
int led;
led = 0;
uart_print ("hello\r\n");
SD_INIT ();
SD_READ (0);
while (1)
{
led++;
uart_print ("%04x\r", led);
GPIO_LED = led;
}
}
int
SD_RW (int data)
{
SPI1_TD = data;
return SPI1_RD & 0xff;
}
void
SD_INIT (void)
{
int i;
SPI1_DV = 6;
SPI1_CS=1;
/* dummy clock */
for (i = 0; i < 10; i++)
{
SD_RW (0xff);
}
sd.cmd[0] = 0x40;
sd.cmd[1] = 0x00;
sd.cmd[2] = 0x00;
sd.cmd[3] = 0x00;
sd.cmd[4] = 0x00;
sd.cmd[5] = CRC7 (sd.cmd, 5) | 1;
SPI1_CS=0;
for (i = 0; i < 6; i++)
{
SD_RW (sd.cmd[i]);
}
do
{ /* response */
sd.res[0] = SD_RW (0xff);
} while (sd.res[0] == 0xff);
SPI1_CS=1;
sd.cmd[0] = 0x41;
sd.cmd[1] = 0x00;
sd.cmd[2] = 0x00;
sd.cmd[3] = 0x00;
sd.cmd[4] = 0x00;
sd.cmd[5] = CRC7 (sd.cmd, 5) | 1;
SPI1_CS=0;
for(;;){
for (i = 0; i < 6; i++)
{
SD_RW (sd.cmd[i]);
}
do
{ /* response */
sd.res[0] = SD_RW (0xff);
} while (sd.res[0] == 0xff);
sd.res[1] = SD_RW (0xff);
if(sd.res[0] ==0||sd.res[1] ==0)
break;
}
SPI1_CS=1;
}
void
SD_READ (int sec)
{
int i;
sd.cmd[0] = 0x51;
sd.cmd[1] = 0x00;
sd.cmd[2] = 0x00;
sd.cmd[3] = sec >> 8;
sd.cmd[4] = sec;
sd.cmd[5] = CRC7 (sd.cmd, 5) | 1;
SPI1_CS=0;
for (i = 0; i < 6; i++)
{
SD_RW (sd.cmd[i]);
}
do
{ /* response */
sd.res[0] = SD_RW (0xff);
}
while (sd.res[0] == 0xff);
do
{ /* start byte */
sd.res[1] = SD_RW (0xff);
}
while (sd.res[1] != 0xfe);
for (i = 0; i < 512; i++)
{
sd.buf[i] = SD_RW (0xff);
}
/* crc1 crc2 */
SD_RW (0xff);
SD_RW (0xff);
/* dummy clock */
SD_RW (0xff);
SPI1_CS=1;
for (i = 0; i < 512; i++)
{
if ((i & 15) == 0)
uart_print ("\n%03x", i);
uart_print (" %02x", sd.buf[i]);
}
uart_print ("\n");
}
void
SD_WRITE (int sec)
{
}
//------- CRC7 by K.I 051020 --------
int
CRC7 (unsigned char c[], int n)
{
int i, j;
unsigned char d, r = 0;
for (i = 0; i < n; i++)
{
d = c[i];
for (j = 0; j < 8; j++)
{
if ((d & 0x80) ^ (r & 0x80))
r = (r << 1) ^ 0x12; // reverse of 0x48
else
r <<= 1;
d <<= 1;
}
}
return (r & 0xFE);
}
sdasz80 -plosgff -o crt.rel crt.asm
sdcc -mz80 -c print.c
sdcc -mz80 -c SD.c
sdcc -mz80 --code-loc 0x100 --no-std-crt0 -Wlcrt.rel SD.rel print.rel
;/****************************************************************************/
;/* コンテキストの切り替え処理 */
;/* */
;/* designed by hamayan */
;/* Copyright (C) 2012 hamayan All Rights Reserved. */
;/****************************************************************************/
.export _swi_ctx ;/*実行コンテキストの切替*/
.export _sta_ctx ;/*コンテキストをロードし、タスクを開始*/
;/************************************************
; コンテキストをロードし、タスクを開始
; void sta_ctx(
; void *exe ) //実行コンテキストの保存先
;************************************************/
.section P,CODE,ALIGN=4
_sta_ctx:
sts pr,@-r15 ;/* pr 退避 */
mov.l @r4,r15 ;/*スタックポインタ設定*/
movmu.l @r15+,r6 ;/*r6-r14,prを復帰*/
rts/n
;/************************************************
; 実行コンテキストの切替
; void swi_ctx(
; void *pre, //現在のコンテキストの保存先
; void *post) //切り替えるコンテキスト
;************************************************/
.section P,CODE,ALIGN=4
_swi_ctx:
movmu.l r6,@-r15 ;/*r6-r14,prを退避。r6が最も若いアドレスになる*/
mov.l r15,@r4 ;/*スタックポインタ保存*/
mov.l @r5,r15 ;/*スタックポインタ復帰*/
movmu.l @r15+,r6 ;/*r6-r14,prを復帰*/
rts/n
.end
;/****************************************************************************/
;/* designed by hamayan */
;/* Copyright (C) 2012 hamayan All Rights Reserved. */
;/****************************************************************************/
;/****************************************************************************/
;/* コンテキストの切り替え処理 */
;/* */
;/* designed by hamayan */
;/* Copyright (C) 2012 hamayan All Rights Reserved. */
;/****************************************************************************/
.syntax unified
.arch armv7-m
.globl swi_ctx ;/*実行コンテキストの切替*/
.globl sta_ctx ;/*コンテキストをロードし、タスクを開始*/
.section .text
;/************************************************
; コンテキストをロードし、タスクを開始
; void sta_ctx(
; void *exe ) //実行コンテキストの保存先
;************************************************/
sta_ctx:
push {lr} ;/*lrを退避*/
ldr r13,[r0] ;/*スタックポインタ設定*/
pop {r4-r12,pc} ;/*r4-r12,pcを復帰*/
;/************************************************
; 実行コンテキストの切替
; void swi_ctx(
; void *pre, //現在のコンテキストの保存先
; void *post) //切り替えるコンテキスト
;************************************************/
swi_ctx:
push {r4-r12,lr} ;/*r4-r12,lrを退避。r4が最も若いアドレスになる*/
str r13,[r0] ;/*スタックポインタ保存*/
ldr r13,[r1] ;/*スタックポインタ復帰*/
pop {r4-r12,pc} ;/*r4-r12,pcを復帰*/
.end
;/****************************************************************************/
;/* designed by hamayan */
;/* Copyright (C) 2012 hamayan All Rights Reserved. */
;/****************************************************************************/