ＡＳＳＥＲＴマクロ

2016.04.03 改良しましたので以下の能書きを読んだ後は、改良版ＡＳＳＥＲＴマクロをどうぞ。 デバッグ版で想定外の動作を検知するマクロにＡＳＳＥＲＴってのがよくあります。 書式は「ＡＳＳＥＲＴ（条件式）；」で条件が不成立になると実行を中断、開発環境によってはマクロの位置でソースを表示してくれます。

ほい来た。 条件不成立でＳＶＣを発行するだけの簡単なお仕事。 あ、リリース版でマクロを無効にするのを忘れてる（苦笑）。

#define KSRK_ASSERT(eval)	if (!(eval)) __asm volatile ("svc #1\n")

ＳＶＣを発行するとSVCall_Handlerに飛びます。 本当はベクタテーブルの１２番目にあるアドレスに飛びますけれど、この辺りの話はcr_startup_lpc17.cに書いてあります。 スーパバイザコールはｌｒで判定してメインスタックかプロセススタックを切り替えます。 ＳＶＣのオペランド（０～２５５の定数）はハンドラへ渡りませんから、ＳＶＣの命令列からオペランドを取得します。 ＦｒｅｅＲＴＯＳのvPortStartFirstTaskがＳＶＣを発行しますからＡＳＳＥＲＴマクロによるものと区別しています。

__attribute__ ((naked)) void SVCall_Handler(void)
{
	__asm volatile (
		"	tst	lr,	#4		\n"	// 使用中のスタックはどちらか？

		"	ite	eq			\n"
		"	mrseq	r0,	msp		\n"	// メインスタックポインタを取得（ＦｒｅｅＲＴＯＳのマルチタスク開始のＳＶＣ発行）
		"	mrsne	r0,	psp		\n"	// プロセススタックポインタを取得（ＫＳＲＫのＡＳＳＥＲＴのＳＶＣ発行）

		"	ldr	r0,	[r0, #24]	\n"	// スタック上のＰＣ⇒戻りアドレス⇒ＳＶＣ命令の次の命令
		"	ldrb	r0,	[r0, #-2]	\n"	// ＳＶＣ命令の１バイト目⇒即値　※２バイト命令でリトルエンディアン
		"	teq	r0,	#1		\n"	// 即値は１？

		"	ittt	eq			\n"	// ＡＳＳＥＲＴ発行は0xffffffffへジャンプしてわざとHardFault発生
		"	movweq	r0,	#0xffff		\n"
		"	movteq	r0,	#0xffff		\n"
		"	bxeq	r0			\n"
		"	b	vPortSVCHandler		\n"	// ＦｒｅｅＲＴＯＳはマルチタスク開始の際に「ＳＶＣ　０」を発行しているので引き継ぐ
	);
}

ＳＶＣ発行時のスタックがメインスタックかプロセススタックか、その判定方法を見つけるまでが長かった。 たまたま別件でＡＲＭ公式サイトのドキュメントを読んでいてサンプルプログラムで上記の方法を見つけた。 おそらくデータシートのどこかには、こっそり目立たず小さく書いてあるのでしょう（もう慣れっこ）。