Plug and produce demonstrators handles multiple processes in the industry, appropriate path planning is essential and at the same time there is an increasing emphasis on more sustainable processes. To ensure the sustainability and automate these processes optimized path planning is required. We present an implementation of a path planning algorithm, which creates a smooth collision free path and considers energy use. In the paper, we demonstrated the implementation of PRM (Probabilistic Road Map) path planning and Dijkstra based optimization algorithm in a simulation environment and thereafter test in a real plug and produce demonstrator. To validate the simulated results the real energy was measured through the signal analyzer online. The measured results outlined in this paper includes; computational time, move along path time, and energy use with different loads. From the experiments and results we conclude that the combination of the two algorithms, PRM with Dijkstra, can be used to generate a collision free optimized path. Here we have considered the distance as the cost function for Dijkstra optimization algorithm and measured the energy of the collision free optimized path. The practical implication of this research is as an enabler for any kind of application where there are large variations of orders e.g., kitting techniques in assembly operations for manufacturing industry.