Updated Test Case for 2-D Square to test both inverse and forward
kinematics for the same example. Renamed function which updated the main
.c file.