Geometric Control for Safety Constraints This code replicates the results of Wu, G. and Sreenath, K. (2016) for the 3D pendulum system.