Input: $ \mathrm{m}\mathrm{a}\mathrm{p}\mathrm{x}{\rm{,}}\;\mathrm{m}\mathrm{a}\mathrm{p}\mathrm{y}{\rm{,}}\;\mathrm{g}\mathrm{s}\mathrm{i}\mathrm{z}\mathrm{e} $ |
Output: $ \mathrm{R}\mathrm{P}\mathrm{s}{\rm{,}}\;\mathbf{D} $ |
Progress: |
1: $ M\leftarrow \mathrm{m}\mathrm{a}\mathrm{p}\mathrm{x}/\mathrm{g}\mathrm{s}\mathrm{i}\mathrm{z}\mathrm{e} $, $ N\leftarrow \mathrm{m}\mathrm{a}\mathrm{p}\mathrm{y}/\mathrm{g}\mathrm{s}\mathrm{i}\mathrm{z}\mathrm{e} $ |
2: $ \mathrm{R}\mathrm{P}\mathrm{s}\leftarrow \mathrm{g}\mathrm{r}\mathrm{i}\mathrm{d}.\mathrm{i}\mathrm{n}\mathrm{i}\mathrm{t}\mathrm{s}\mathrm{i}\mathrm{z}\mathrm{e}(M{\rm{,}}\;N) $ |
3: $ \mathbf{D}\leftarrow \left[\right]{\rm{,}}\;\mathbf{F}\leftarrow \left[\right]{\rm{,}}\;\mathbf{L}\leftarrow \left[ \right] $ |
4: for $ \mathrm{r}\mathrm{o}\mathrm{w}=0 :N $ do |
5: for $ \mathrm{c}\mathrm{o}\mathrm{l}=0 :M $ do |
6: $ \mathbf{r}\leftarrow \left[ \right] $ |
7: $ C\leftarrow 40{\rm{,}}\;P\leftarrow 0{\rm{,}}\;\Omega \leftarrow 0{\rm{,}}\;\Phi \leftarrow 0 $ |
8: for $ i=0 :K $ do |
9: $ P\leftarrow {P}^{i} $ |
10: $ \lambda \leftarrow {\lambda }^{i} $ |
11: ${a}_{x}^{i}\leftarrow \mathrm{l}\mathrm{o}\mathrm{c}\mathrm{a}\mathrm{t}\mathrm{i}\mathrm{o}\mathrm{n}\mathrm{x}\left({{\mathrm{AP}}}_{i}\right){\rm{,} }\;{a}_{y}^{i}\leftarrow \mathrm{l}\mathrm{o}\mathrm{c}\mathrm{a}\mathrm{t}\mathrm{i}\mathrm{o}\mathrm{n}\mathrm{y}\left({{\mathrm{AP}}}_{i}\right){\rm{,} }\;{a}_{z}^{i}\leftarrow $$\mathrm{l}\mathrm{o}\mathrm{c}\mathrm{a}\mathrm{t}\mathrm{i}\mathrm{o}\mathrm{n}\mathrm{z}\left({{\mathrm{AP}}}_{i}\right) $ |
12: // $ ** $ is the power operator |
13: $\Omega =10*n*\mathrm{l}\mathrm{o}\mathrm{g}10\left(\left(\left(\mathrm{r}\mathrm{o}\mathrm{w}-{a}_{x}^{i}\right)**2+\left(\mathrm{c}\mathrm{o}\mathrm{l}-{a}_{y}^{i}\right)**2+ $$ \left(1.5-{a}_{z}^{i}\right)**2\right)**0.5\right)$ |
14: $ \Phi \leftarrow 0 $ |
15: for $ j=0 :T $ do |
16: if $ \mathrm{i}\mathrm{s}\mathrm{I}\mathrm{n}\mathrm{t}\mathrm{e}\mathrm{r}\mathrm{s}\mathrm{e}\mathrm{c}\left({\mathrm{p}\mathrm{o}\mathrm{i}\mathrm{n}\mathrm{t}}_{\mathrm{r}\mathrm{o}\mathrm{w}}{\rm{,}}\;{\mathrm{p}\mathrm{o}\mathrm{i}\mathrm{n}\mathrm{t}}_{\mathrm{c}\mathrm{o}\mathrm{l}}{\rm{,}}\;{a}_{x}^{i}{\rm{,}}\;{a}_{y}^{i}\right)==\mathrm{t}\mathrm{r}\mathrm{u}\mathrm{e} $ do |
17: $ \Phi \leftarrow \Phi +{\beta }_{j} $ |
18: end if |
19: end for |
20: $ \Gamma =C+{{\mathrm{log}}}10\left(\lambda /2.4\right)+\Omega +\Phi $ |
21: $ \mathbf{r}\leftarrow \mathrm{r}{\mathrm{.}}\mathrm{a}\mathrm{p}\mathrm{p}\mathrm{e}\mathrm{n}\mathrm{d}(P-\Gamma ) $ |
22: end for |
23: $ \mathbf{F}\leftarrow \mathrm{F}.\mathrm{a}\mathrm{p}\mathrm{p}\mathrm{e}\mathrm{n}\mathrm{d}\left({\bf{r}}\right){\rm{,}}\;\mathbf{L}\leftarrow \mathrm{L}{\mathrm{.}}\mathrm{a}\mathrm{p}\mathrm{p}\mathrm{e}\mathrm{n}\mathrm{d}\left([\mathrm{r}\mathrm{o}\mathrm{w}{\rm{,}}\;\mathrm{c}\mathrm{o}\mathrm{l}]\right); $ |
24: $ \mathrm{R}\mathrm{P}\mathrm{s}[\mathrm{r}\mathrm{o}\mathrm{w}{\rm{,}}\;\mathrm{ }\mathrm{c}\mathrm{o}\mathrm{l}]\leftarrow \mathbf{r} $ |
25: end for |
26: end for |
27:$ \mathbf{D}\leftarrow \mathbf{F}+\mathbf{L} $ |