Occupancy-SLAM: Simultaneously Optimizing Robot Poses and Continuous Occupancy Map