Use N instead of K to represent the number of hidden states
Add inc/add; Add EstimateC and unit test; Add Init