Alot of fixes, program now works

For 3-5floor