Added cone implementation, have not checked whether it is correct or not.

Added rpoly in preparation for Torus - only skeleton
WIP changing vector[i] to vector(i) because apparently faster?