Add Cone from #12

@jdan @Hermanya I merged your old code with the newest version and it works with the test file