Fixed Solver issue, range, sover, IMU working