edges weights added on debug, just the length of the path, not the rotations though