[fix] Fix pose graph without external poses

• The last MR has introduced a bug when optimizing the PGO without external poses. It is fixed here.
• Some minor style issues are also fixed for PV