partially through creating class version
initial system working. try with casadi now