Finished the basic program, maybe I'll add some trigo functions