I've written a state machine with 6 states,
It uses two encoders to know if to stay or proceed.
Image:
It includes a 'wheel distance' sub vi:
The sub vi takes the output of the encoder and makes it a distance in cm (it isnt the problem)
The issue is that the robot doesnt move at all.
I used Highlight and it look like the motors DO get the value and should move and then it enters the parallel loops and stays there forever because the robot doesnt move.
Code explained: (If you didnt get it)
It takes the current value of the encoder and adds it 50 (cm)
Then it gives the motors a value until both of the encoders encrease by 50,
then it moves to the next state and so on...
So, I can't figure out why the motors don't move
BTW they move in the teleop so it's not about the jaguars or PWMs.
Thx for the helpers
