Update 3d math code in Glide64mk2 too