In this work, we introduce a novel Geometric Motion Planning algorithm that enables robots to adeptly execute constrained tasks. The proposed algorithm inherently adheres to two predominant task constraints: pure translation and pure rotation, thereby ensuring enhanced operational efficiency in various applications.
We also present a geometric method for the meticulous calibration of simulation workspaces to seamlessly align with their experimental counterparts. This approach proves especially beneficial for accurately replicating simulation workspaces in real life during the initial prototyping phase, enhancing the reliability and effectiveness of robotic systems in practical scenarios.