Add formula to calculate vehicale coordinate system