Skip to content

matlab/matlab-agentic-toolkit / skills-catalog/automotive/roadrunner-rrhd-authoring

roadrunner-rrhd-authoring

Verified

Build RoadRunner HD Map entities in MATLAB — lanes, boundaries, markings, junctions, signs, signals, barriers, parking. Use when creating driving scenes from scratch, authoring road networks for simulation and testing automated driving systems, or assembling RRHD maps from Lanelet2 or other HD map sources.

scripts/snapConnectedEndpoints.m

View on GitHub
function [lanes, laneBoundaries, snapCount] = snapConnectedEndpoints(lanes, laneBoundaries, threshold)
%snapConnectedEndpoints Snap lane and boundary endpoints for connected lanes.
%   [lanes, laneBoundaries, snapCount] = snapConnectedEndpoints(lanes, laneBoundaries)
%   snaps successor start points to predecessor end points for connected
%   lane pairs with gaps under threshold (default 1.0m). Also snaps
%   corresponding boundary endpoints respecting alignment direction.
%
%   [lanes, laneBoundaries, snapCount] = snapConnectedEndpoints(lanes, laneBoundaries, threshold)
%   uses a custom distance threshold in meters.
%
%   Inputs:
%     lanes           - Array of roadrunner.hdmap.Lane objects
%     laneBoundaries  - Array of roadrunner.hdmap.LaneBoundary objects
%     threshold       - Maximum gap to snap (default 1.0m)
%
%   Outputs:
%     lanes           - Lanes with snapped center line endpoints
%     laneBoundaries  - Boundaries with snapped endpoints
%     snapCount       - Number of connections snapped

% Copyright 2026 The MathWorks, Inc.

    arguments
        lanes
        laneBoundaries
        threshold (1,1) double = 1.0
    end

    % Build ID -> index maps
    laneIdx = containers.Map('KeyType','char','ValueType','double');
    for i = 1:numel(lanes), laneIdx(char(string(lanes(i).ID))) = i; end
    bndIdx = containers.Map('KeyType','char','ValueType','double');
    for i = 1:numel(laneBoundaries), bndIdx(char(string(laneBoundaries(i).ID))) = i; end

    % Determine boundary alignment per lane via dot product
    nLanes = numel(lanes);
    leftFwd = true(nLanes,1);
    rightFwd = true(nLanes,1);
    for i = 1:nLanes
        lDir = lanes(i).Geometry(2,:) - lanes(i).Geometry(1,:);
        lbID = char(string(lanes(i).LeftLaneBoundary.Reference.ID));
        if isKey(bndIdx, lbID)
            bg = laneBoundaries(bndIdx(lbID)).Geometry;
            leftFwd(i) = dot(lDir(1:2), bg(2,1:2) - bg(1,1:2)) >= 0;
        end
        rbID = char(string(lanes(i).RightLaneBoundary.Reference.ID));
        if isKey(bndIdx, rbID)
            bg = laneBoundaries(bndIdx(rbID)).Geometry;
            rightFwd(i) = dot(lDir(1:2), bg(2,1:2) - bg(1,1:2)) >= 0;
        end
    end

    % Snap: successor start -> predecessor end
    snapCount = 0;
    for i = 1:nLanes
        predEnd = lanes(i).Geometry(end,:);
        for k = 1:numel(lanes(i).Successors)
            succID = char(string(lanes(i).Successors(k).Reference.ID));
            if ~isKey(laneIdx, succID), continue; end
            j = laneIdx(succID);
            gap = norm(predEnd(1:2) - lanes(j).Geometry(1,1:2));
            if gap > threshold || gap < 1e-6, continue; end

            % Snap lane center
            lanes(j).Geometry(1,1:2) = predEnd(1:2);

            % Snap left boundary
            predLB = char(string(lanes(i).LeftLaneBoundary.Reference.ID));
            succLB = char(string(lanes(j).LeftLaneBoundary.Reference.ID));
            if isKey(bndIdx, predLB) && isKey(bndIdx, succLB)
                if leftFwd(i), srcPt = laneBoundaries(bndIdx(predLB)).Geometry(end,1:2);
                else, srcPt = laneBoundaries(bndIdx(predLB)).Geometry(1,1:2); end
                if leftFwd(j), laneBoundaries(bndIdx(succLB)).Geometry(1,1:2) = srcPt;
                else, laneBoundaries(bndIdx(succLB)).Geometry(end,1:2) = srcPt; end
            end

            % Snap right boundary
            predRB = char(string(lanes(i).RightLaneBoundary.Reference.ID));
            succRB = char(string(lanes(j).RightLaneBoundary.Reference.ID));
            if isKey(bndIdx, predRB) && isKey(bndIdx, succRB)
                if rightFwd(i), srcPt = laneBoundaries(bndIdx(predRB)).Geometry(end,1:2);
                else, srcPt = laneBoundaries(bndIdx(predRB)).Geometry(1,1:2); end
                if rightFwd(j), laneBoundaries(bndIdx(succRB)).Geometry(1,1:2) = srcPt;
                else, laneBoundaries(bndIdx(succRB)).Geometry(end,1:2) = srcPt; end
            end

            snapCount = snapCount + 1;
        end
    end
end
finishing-a-development-branchobra/superpowersUse when implementation is complete, all tests pass, and you need to decide how to integrate the workStars: 322kUpdated Claude CodeCodexVerifiedInstall
systematic-debuggingobra/superpowersUse when encountering any bug, test failure, or unexpected behavior, before proposing fixesStars: 322kUpdated Claude CodeCodexVerifiedInstall
test-driven-developmentobra/superpowersUse when implementing any feature or bugfix, before writing implementation codeStars: 322kUpdated Claude CodeCodexVerifiedInstall
skill-creatoranthropics/skillsCreate new skills, modify and improve existing skills, and measure skill performance. Use when users want to create a skill from scratch, edit, or optimize an existing skill, run evals to test a skill, benchmark skill performance with variance analysis, or optimize a skill's description for better triggering accuracy.Stars: 197kUpdated Claude CodeCodexVerifiedInstall