Simple Warehouse Optimal Path Implementation

- a simple optimal path demo using a package I made