diff options
| author | Nao Pross <np@0hm.ch> | 2023-05-02 13:27:31 +0200 |
|---|---|---|
| committer | Nao Pross <np@0hm.ch> | 2023-05-02 13:27:31 +0200 |
| commit | e29fa3f2c56286eaaccb6fbe54029037f2a02d5b (patch) | |
| tree | 3a368953d23745ddd18e0a9d4173c60a09e74082 /templates/generate_constraints.m | |
| parent | ADD: Create .gitignore (diff) | |
| download | mpc_pe-e29fa3f2c56286eaaccb6fbe54029037f2a02d5b.tar.gz mpc_pe-e29fa3f2c56286eaaccb6fbe54029037f2a02d5b.zip | |
ADD: Tasks 1-9
Diffstat (limited to 'templates/generate_constraints.m')
| -rw-r--r-- | templates/generate_constraints.m | 7 |
1 files changed, 6 insertions, 1 deletions
diff --git a/templates/generate_constraints.m b/templates/generate_constraints.m index 892b706..e2e4357 100644 --- a/templates/generate_constraints.m +++ b/templates/generate_constraints.m @@ -7,5 +7,10 @@ %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% function [H_u, h_u, H_x, h_x] = generate_constraints(params) - % YOUR CODE HERE + H_u = [eye(params.model.nu); -eye(params.model.nu)]; + h_u = params.constraints.MaxAbsThrust * ones(params.model.nu*2,1); + + H_x = [eye(3), zeros(3); -eye(3), zeros(3)]; % * inv(params.model.ScalingMatrix); + h_x = params.constraints.MaxAbsPositionXZ * [1, 0, 1, 1, 0, 1].' + ... + params.constraints.MaxAbsPositionY * [0, 1, 0, 0, 1, 0].'; end
\ No newline at end of file |