Start working on lap + trkseg impl - needs more work