...
- Implemented a simulator in C for Linux. This is integrated with the code used on cars (ca2). It simulates the cars dynamics and the behavior of the Camera Positioning Systems (CPS). Besides being very useful to verify the system model, it makes easy to test changes to code and the controller before applying those changes to cars.
- Implemented a script to visually debug cars behavior. It works both with the simulator and test-bed experiments data.
- ca2: grouped utility functions in a separate folder that is shared with the simulator. This makes the code more modular.
- ca2: partially implemented a Kalman filter in the attempt to remove part of the measurement noise of cameras. The model must be refined for it to prove its real effectiveness.
- CPS: fixed a bug that affected the initial target dectection for cars that were not tracked by computer 0.
- CPS: now compute and send also the 2D speed of the cars. This is likely to be needed for the predictor in the future. See also section #CPS MEASURED 2D SPEED.
- CPS: implemented linear error correction for the computation of camera position. This visibly improves the path following of cars. See section #CAMERA MEASUREMENT ERROR CORRECTION.
Note about CPS usage. Since CPS now compute and send the 2D speed to cars, AndreaCPS is not compatible to previous ca2 versions. Viceversa my ca2 is not compatible with previous version of CPS. This is because the communication protocol between CPS and ca2 is now a little bit different. In general I would suggest using AndreaCPS instead of KevinCPS or LeoCPS. This because of the bug that involved the initial target detection. I did not check CPS versions that are previous to KevinCPS but it is likely that those versions do not have this bug since computer 1 and 2 do not send their information to computer 0 before sending them to cars.
...
- peaks in CPS speed are likely to be caused by position leaps between cameras;
- CPS speed average is above the one measured with the encoder.
CAR MODEL
...
STEER INPUT - CURVATURE RADIUS RELATIONSHIP
...
If one considers the car to have an ideal lateral dynamics then the vehicle can be represented as in Figure car.png.
EFFECT OF PWM AND STEER INPUT ON THE SPEED DYNAMICS
...