Add vector functions: sub, len, unit, dot and normal