Implemented check for sensor failure test on vx, vy, px, py, and angle