少ない脳みそ絞って書いてみた。
3Dとかアフィン変換とかサッパリなので2Dで。
http://gamdev4.hp.infoseek.co.jp/cgi-bin/up/No_0080zip.html