Added ArcLength and testing for ArcLength

:)