**Acknowledgements**

This work was supported by Nihon University Multidisciplinary Research Grant for (2020) and supported by Research Institute of Science and Technology Nihon University College of Science and Technology Leading Research Promotion Grant. Also, the part of the work was supported by JSPS KAKENHI Grant Number JP18K04060. The authors appreciated the Nihon University Robotics Society (NUROS).
