Fix integral cost in stomp for IOC
First working IOC