diff --git a/bioloid_controller_cm510/CMakeLists.txt b/bioloid_controller_cm510/CMakeLists.txt
index 97703550d7d121ba041e9eb8c27f6d46ec25e077..f9c36474af76b798e69b90d8001cbf25b60466ab 100644
--- a/bioloid_controller_cm510/CMakeLists.txt
+++ b/bioloid_controller_cm510/CMakeLists.txt
@@ -91,7 +91,7 @@ catkin_package(
 ###########
 
 SET(BIOLOID_FW_PATH ~/humanoids/cm510_controller_fw)
-SET(ProjectPath ~/Desktop/new_fw/sensors)
+SET(ProjectPath ~/humanoids/cm510_controller_fw/examples/stairs)
 
 ## Specify additional locations of header files
 ## Your package locations should be listed before other locations
@@ -105,6 +105,7 @@ include_directories(${iriutils_INCLUDE_DIR})
 INCLUDE_DIRECTORIES(${robotis_bin_parser_INCLUDE_DIR})
 INCLUDE_DIRECTORIES(${robotis_mtn_parser_INCLUDE_DIR})
 INCLUDE_DIRECTORIES(${robotis_mtn_INCLUDE_DIR})
+INCLUDE_DIRECTORIES(${ProjectPath}/../movements/)
 
 ## Declare a cpp library
 # add_library(bioloid_controller
@@ -126,8 +127,8 @@ add_library(${PROJECT_NAME} src/bioloid_controller_cm510.cpp
                             ${BIOLOID_FW_PATH}/communications/src/dynamixel.c
                             ${BIOLOID_FW_PATH}/communications/src/serial_console.c
                             # main application module
-                           
-		            ${ProjectPath}/main.c
+		            ${ProjectPath}/stairs.c
+		            ${ProjectPath}/../movements/mtn_library.c
                             # AVR simulation modules
                             src/sim/avr_delay.c
                             src/sim/avr_registers.c