Patent ID: 11892297
Assignee: ROBERT BOSCH GMBH
Field: Computer technology (Electrical engineering)
Classification: CPC G | IPC G

Claim 3:
4. The method of claim 3, wherein the updates for the distributed Graph SLAM algorithm are defined in terms of constrained and non-constrained vertices such that, Δ
      ⁢
      
       
        x
        ⌣
       
       s
       
        l
        +
        1
       
      
     
     =
     
      
       -
       
        
         (
         
          
           
            H
            ⌣
           
           s
           k
          
          +
          
           ρ
           ⁢
           I
          
         
         )
        
        
         -
         1
        
       
      
      ⁢
      
       (
       
        
         
          b
          
           ⌣
          
         
         s
         k
        
        +
        
         ρ
         ⁢
         
          
           u
           ⌣
          
          s
          l
         
        
        -
        
         ρ
         ⁢
         
          z
          s
          l
         
        
       
       )
      
     
    
   
  
  
   
    
     
      z
      
       l
       +
       1
      
     
     =
     
      
       z
       l
      
      -
      
       α
       ⁢
       
        v
        1
       
      
      +
      
       
        α
        S
       
       ⁢
       
        
         ∑
         
          s
          =
          1
         
         S
        
        
         
          
           D
           ⌣
          
          s
          T
         
         (
         
          
           Δ
           ⁢
           
            
             x
             ⌣
            
            s
            
             l
             +
             1
            
           
          
          -
          
           
            z
            ⌣
           
           s
           l
          
          +
          
           
            v
            ⌣
           
           s
           l
          
         
         )
        
       
      
     
    
   
  
  
   
    
     
      ψ
      
       l
       +
       1
      
     
     =
     
      
       z
       
        l
        +
        1
       
      
      -
      
       z
       l
      
     
    
   
  
  
   
    
     
      v
      
       l
       +
       1
      
     
     =
     
      
       
        (
        
         1
         -
         α
        
        )
       
       ⁢
       
        v
        l
       
      
      -
      
       ψ
       
        l
        +
        1
       
      
     
    
   
  
  
   
    
     
      
       ϕ
       ⌣
      
      s
      
       l
       +
       1
      
     
     =
     
      
       Δ
       ⁢
       
        
         x
         ⌣
        
        s
        
         l
         +
         1
        
       
      
      -
      
       
        z
        ⌣
       
       s
       
        l
        +
        1
       
      
     
    
   
  
  
   
    
     
      
       ψ
       ⌣
      
      s
      
       l
       +
       1
      
     
     =
     
      
       
        z
        ⌣
       
       s
       
        l
        +
        1
       
      
      -
      
       
        z
        ⌣
       
       s
       l
      
     
    
   
  
  
   
    
     
      
       u
       ⌣
      
      s
      
       l
       +
       1
      
     
     =
     
      
       
        u
        ⌣
       
       s
       l
      
      +
      
       α
       ⁢
       
        
         ϕ
         ⌣
        
        s
        
         l
         +
         1
        
       
      
      +
      
       
        (
        
         α
         -
         1
        
        )
       
       ⁢
       
        
         ψ
         ⌣
        
        s
        
         l
         +
         1
        
       
      
     
    
   
  
  
   
    
     
      
       
       
        
         ϕ
         ⌣
        
        s
        
         l
         +
         1
        
       
       
      
      2
     
     =
     
      
       S
       ⁢
       
        
         
         
          
           ψ
           
            k
            +
            1
           
          
          =
          
           v
           k
          
         
         
        
        2
       
      
      +
      
       
        ∑
        
         s
         =
         1
        
        S
       
       
        
         
         
          
           ϕ
           ⌣
          
          s
          
           k
           +
           1
          
         
         
        
        2
       
      
      -
      
       
        
         
         
          
           
            ψ
            ⌣
           
           s
           
            k
            +
            1
           
          
          +
          
           
            v
            ⌣
           
           s
           l
          
         
         
        
        2
       
       .