Working on lambert solver