An obstacle avoidance path planning algorithm to simulate hyper redundant manipulators for tokamaks maintenance