Fixed some stuff. Cross product is broken right now.
Added some much needed functions