Closed dfridovi closed 3 years ago
See around (54) here: https://bjack205.github.io/papers/AL_iLQR_Tutorial.pdf. Basically, I think we don't actually need costates but the line search does need to change - it should be on the actual cost and not on the KKT conditions.
Right now the line search doesn't use the costates at all. Maybe this should be used in order to counterbalance costs which can't feasibly be minimized.