Currently, underwater infrastructure facilities in Japan are rapidly aging, but most of them are not inspected by divers because the current inspection by divers is inefficient and potentially dangerous. To realize a system that can inspect underwater infrastructures safely and efficiently, this study develops a motion control system for an underwater robot that is part of the underwater infrastructure inspection system.