Как при повторном клике сдвигать в исходное положение?

const foo = document.querySelector(".foo"); 
const baz = document.querySelector(".baz"); 
const height = foo.offsetHeight; 
 
foo.addEventListener("click", () => { 
  if (!foo.classList.contains("foo_open")) { 
    foo.classList.add("foo_open"); 
    baz.style.marginTop = height + "px"; 
  } else { 
    foo.classList.remove("foo_open"); 
    baz.style.marginTop = 0; 
  } 
});

.foo, 
.baz { 
  width: 50px; 
  height: 50px; 
  background-color: pink; 
  cursor: pointer; 
} 
 
.baz { 
  background-color: green; 
}

<div class="foo"></div> 
<div class="baz"></div>