v2 still brand new

added beginning functions. Stuck on trajectory equation