I am not sure if you have a syntax error or logic error. the former one is straight forward solve by tracing your code and clean it up. the logic error depends on the methods you use, so it needs to revise the theory and the equations related to it.
thanks
Mohamed Abouseif