Add code for trains
code for servo motor
add code for old controller