Added robsympy and tests