PD in V5 blocks

Well I tried to use PD in blocks and this is how this go. I tried it on my robot but it is just the same as if I did not use PD. I do understand how the PD works but not sure how to imply it here.

This is my improve version but i did not tune the kp,ki, kd value yet. I wanna know what yall think about this and is there any logic mistake i made or should I improve?

I am not the best at explaining this type of thing but I also attempted to do PID in blocks and was able to get it working but wasn’t able to go far with it as I swapped over to the jar template (worth looking into) not long after I got it working but the thread is (Using blocks to run a PID auton)
And I would recommend taking a look through this manual I found it super helpful
introduction_to_pid_controllers_ed2.pdf (400.2 KB)

Please lmk if that helped at all

Well I did take a look at the JAR template after I want to use PID in auto correction long ago and it didn’t work out well. Because here’s the problem, I am not familiar with C++ at all. That’s why I seek to block instead of a lot of templates. Can you explain to me more about your attempt?

I just read the paper posted above and copied the code at the end in v5blocks and one thing with your code is you will need to add a move forward code to your pid and then set the velocity and I would recommend adding a tolerance to the exit value otherwise you will most likely get in a loop of oscillation and you might need to add a settling thing