Implementation of Quaternion and Vector in Simulation