Create a 7-Segment Display!

1void setup()
2{
3  init();
4  /*your setup code here*/
5}
6
7void  loop()
8{
9  /*
10   * your loop code here
11   *
12   * use display(num,  dp) to display num (0123456789ABCDEF)
13   * and the dot (if dp).
14   *
15   *  you can turn off all the leds by writing display().
16   */
17}
18
19void init()
20{
21  pinMode(2, OUTPUT);
22  pinMode(3, OUTPUT);
23  pinMode(4, OUTPUT);
24  pinMode(5,  OUTPUT);
25  pinMode(6, OUTPUT);
26  pinMode(7, OUTPUT);
27  pinMode(8, OUTPUT);
28  pinMode(9, OUTPUT);
29}
30
31void display(int n=-1, boolean dp)
32{
33  digitalWrite(9,  !dp);
34  if(num == 0)
35  {
36    digitalWrite(2, 0);
37    digitalWrite(3,  0);
38    digitalWrite(4, 0);
39    digitalWrite(5, 0);
40    digitalWrite(6,  0);
41    digitalWrite(7, 0);
42    digitalWrite(8, 1);
43  } else if(num ==  1) {
44    digitalWrite(2, 1);
45    digitalWrite(3, 0);
46    digitalWrite(4,  0);
47    digitalWrite(5, 1);
48    digitalWrite(6, 1);
49    digitalWrite(7,  1);
50    digitalWrite(8, 1);
51  } else if(num == 2) {
52    digitalWrite(2,  0);
53    digitalWrite(3, 0);
54    digitalWrite(4, 1);
55    digitalWrite(5,  0);
56    digitalWrite(6, 0);
57    digitalWrite(7, 1);
58    digitalWrite(8,  0);
59  } else if(num == 3) {
60    digitalWrite(2, 0);
61    digitalWrite(3,  0);
62    digitalWrite(4, 0);
63    digitalWrite(5, 0);
64    digitalWrite(6,  1);
65    digitalWrite(7, 1);
66    digitalWrite(8, 0);
67  } else if(num ==  4) {
68    digitalWrite(2, 1);
69    digitalWrite(3, 0);
70    digitalWrite(4,  0);
71    digitalWrite(5, 1);
72    digitalWrite(6, 1);
73    digitalWrite(7,  0);
74    digitalWrite(8, 0);
75  } else if(num == 5) {
76    digitalWrite(2,  0);
77    digitalWrite(3, 1);
78    digitalWrite(4, 0);
79    digitalWrite(5,  0);
80    digitalWrite(6, 1);
81    digitalWrite(7, 0);
82    digitalWrite(8,  0);
83  } else if(num == 6) {
84    digitalWrite(2, 0);
85    digitalWrite(3,  1);
86    digitalWrite(4, 0);
87    digitalWrite(5, 0);
88    digitalWrite(6,  0);
89    digitalWrite(7, 0);
90    digitalWrite(8, 0);
91  } else if(num ==  7) {
92    digitalWrite(2, 0);
93    digitalWrite(3, 0);
94    digitalWrite(4,  0);
95    digitalWrite(5, 1);
96    digitalWrite(6, 1);
97    digitalWrite(7,  1);
98    digitalWrite(8, 1);
99  } else if(num == 8) {
100    digitalWrite(2,  0);
101    digitalWrite(3, 0);
102    digitalWrite(4, 0);
103    digitalWrite(5,  0);
104    digitalWrite(6, 0);
105    digitalWrite(7, 0);
106    digitalWrite(8,  0);
107  } else if(num == 9) {
108    digitalWrite(2, 0);
109    digitalWrite(3,  0);
110    digitalWrite(4, 0);
111    digitalWrite(5, 0);
112    digitalWrite(6,  1);
113    digitalWrite(7, 0);
114    digitalWrite(8, 0);
115  } else if(num ==  10) {
116    digitalWrite(2, 0);
117    digitalWrite(3, 0);
118    digitalWrite(4,  0);
119    digitalWrite(5, 1);
120    digitalWrite(6, 0);
121    digitalWrite(7,  0);
122    digitalWrite(8, 0);
123  } else if(num == 11) {
124    digitalWrite(2,  1);
125    digitalWrite(3, 1);
126    digitalWrite(4, 0);
127    digitalWrite(5,  0);
128    digitalWrite(6, 0);
129    digitalWrite(7, 0);
130    digitalWrite(8,  0);
131  } else if(num == 12) {
132    digitalWrite(2, 0);
133    digitalWrite(3,  1);
134    digitalWrite(4, 1);
135    digitalWrite(5, 0);
136    digitalWrite(6,  0);
137    digitalWrite(7, 0);
138    digitalWrite(8, 1);
139  } else if(num ==  13) {
140    digitalWrite(2, 1);
141    digitalWrite(3, 0);
142    digitalWrite(4,  0);
143    digitalWrite(5, 0);
144    digitalWrite(6, 0);
145    digitalWrite(7,  1);
146    digitalWrite(8, 0);
147  } else if(num == 14) {
148    digitalWrite(2,  0);
149    digitalWrite(3, 1);
150    digitalWrite(4, 1);
151    digitalWrite(5,  0);
152    digitalWrite(6, 0);
153    digitalWrite(7, 0);
154    digitalWrite(8,  0);
155  } else if(num == 15) {
156    digitalWrite(2, 0);
157    digitalWrite(3,  1);
158    digitalWrite(4, 1);
159    digitalWrite(5, 1);
160    digitalWrite(6,  0);
161    digitalWrite(7, 0);
162    digitalWrite(8, 0);
163  } else {
164    digitalWrite(2,  1);
165    digitalWrite(3, 1);
166    digitalWrite(4, 1);
167    digitalWrite(5,  1);
168    digitalWrite(6, 1);
169    digitalWrite(7, 1);
170    digitalWrite(8,  1);
171  }
172}