Add documentation and use array access internally

Updated documentation.
Used array access for Vector and Matrix internally for increased performance.