Got rid of superfluous Vector shift calculations
Fixed conf level. Started on fixing rotations but may not be able to figure it out in time.