Port code from XNA Math to DirectXMath lib

Signed-off-by: MHesham <mhesham.fcis@gmail.com>