Use numpy array operations whenever possible over loops
Add matlab implementation of mean_geo_speed