Changed folder structure, added 2. mass

PID Controller is not working properly yet.
Force controller is, need to update the other two as well.