Traction Control System Issues

I am currently developing a traction control system, but I am fairly new to coding. After many hours developing it, I find the results obtained from the mode wrong (noticed when looking at the yaw rate vs s and v vs t). Can someone experienced have a look at the attached code as I have recently started coding and I am unsure about certain statements? TCS.m will run the code