Benchmarking work
Switched to IKFAST
Created experimental script for pendulum