Added all getters and setters for angles
Added second rotation calculations in Chain

Also fixed several errors from previous commits