Extend Coordinate change matrices to include joint 4.