Still debugging matrix math