In CVX folder, worked through Nao robot forward kinematics. Creating SCP software for inverse control