1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
//! Container to store and set display properties
use crate::{
command::{Command, VcomhLevel, AddrMode},
displayrotation::DisplayRotation,
displaysize::DisplaySize,
interface::DisplayInterface,
};
use crate::brightness::Brightness;
/// Display properties struct
pub struct DisplayProperties<DI> {
iface: DI,
addr_mode: AddrMode,
display_size: DisplaySize,
display_rotation: DisplayRotation,
draw_area_start: (u8, u8),
draw_area_end: (u8, u8),
draw_column: u8,
draw_row: u8,
}
impl<DI> DisplayProperties<DI>
where
DI: DisplayInterface,
{
/// Create new DisplayProperties instance
pub fn new(
iface: DI,
display_size: DisplaySize,
display_rotation: DisplayRotation,
addr_mode: AddrMode,
) -> DisplayProperties<DI> {
DisplayProperties {
iface,
display_size,
addr_mode,
display_rotation,
draw_area_start: (0, 0),
draw_area_end: (0, 0),
draw_column: 0,
draw_row: 0,
}
}
/// Initialise the display in column mode (i.e. a byte walks down a column of 8 pixels) with
/// column 0 on the left and column _(display_width - 1)_ on the right.
pub fn init_column_mode(&mut self) -> Result<(), DI::Error> {
/*** OJSoriginal code below
self.iface.init()?;
// TODO: Break up into nice bits so display modes can pick whathever they need
let (_, display_height) = self.display_size.dimensions();
let display_rotation = self.display_rotation;
Command::DisplayOn(false).send(&mut self.iface)?;
Command::DisplayClockDiv(0x8, 0x0).send(&mut self.iface)?; // OJS param is << 4
Command::Multiplex(display_height - 1).send(&mut self.iface)?;
Command::DisplayOffset(0).send(&mut self.iface)?;
Command::StartLine(0).send(&mut self.iface)?;
// TODO: Ability to turn charge pump on/off
// Display must be off when performing this command
Command::ChargePump(true).send(&mut self.iface)?;
Command::MemoryMode(0x02).send(&mut self.iface);
self.set_rotation(display_rotation)?;
match self.display_size {
DisplaySize::Display128x32 => Command::ComPinConfig(false).send(&mut self.iface),
DisplaySize::Display128x64
| DisplaySize::Display128x64NoOffset
| DisplaySize::Display132x64 => Command::ComPinConfig(true).send(&mut self.iface),
}?;
Command::Contrast(0x8f).send(&mut self.iface)?; // OJS: was 0x80
Command::PreChargePeriod(0x1, 0xf).send(&mut self.iface)?; // OJS: was 0x1, 0xf
Command::VcomhDeselect(VcomhLevel::Auto).send(&mut self.iface)?;
Command::Vpp9VSet().send(&mut self.iface)?; // OJS: added this
Command::AllOn(false).send(&mut self.iface)?;
Command::Invert(false).send(&mut self.iface)?;
Command::DeactivateScroll().send(&mut self.iface)?; // OJS: added this
Command::DisplayOn(true).send(&mut self.iface)?;
******/
let display_rotation = self.display_rotation;
Command::DisplayOn(false).send(&mut self.iface)?;
Command::DisplayClockDiv(0x8, 0x0).send(&mut self.iface)?;
let (_, display_height) = self.display_size.dimensions();
Command::Multiplex(display_height - 1).send(&mut self.iface)?;
Command::DisplayOffset(0).send(&mut self.iface)?;
Command::StartLine(0).send(&mut self.iface)?;
// TODO: Ability to turn charge pump on/off
Command::ChargePump(true).send(&mut self.iface)?;
Command::AddressMode(AddrMode::Horizontal).send(&mut self.iface)?;
// self.size.configure(&mut self.interface)?;
// match self.display_size {
// DisplaySize::Display128x32 => Command::ComPinConfig(false).send(&mut self.iface),
// DisplaySize::Display128x64 | DisplaySize::Display128x64NoOffset
// | DisplaySize::Display132x64 => Command::ComPinConfig(true).send(&mut self.iface),
// }?;
match self.display_size {
DisplaySize::Display128x32 => Command::ComPinConfig(false, false).send(&mut self.iface),
DisplaySize::Display128x64NoOffset => Command::ComPinConfig(true, false).send(&mut self.iface),
DisplaySize::Display128x64 => Command::ComPinConfig(true, false).send(&mut self.iface),
DisplaySize::Display132x64 => Command::ComPinConfig(true, false).send(&mut self.iface), // ?
} ?;
log::debug!("init_column_mode, rotation.");
self.set_rotation(display_rotation)?;
log::debug!("init_column_mode, brightness.");
self.set_brightness(Brightness::default())?;
Command::VcomhDeselect(VcomhLevel::Auto).send(&mut self.iface)?;
Command::AllOn(false).send(&mut self.iface)?;
Command::Invert(false).send(&mut self.iface)?;
log::debug!("init_column_mode, EnableScroll.");
Command::EnableScroll(false).send(&mut self.iface)?;
log::debug!("init_column_mode, DisplayOn.");
Command::DisplayOn(true).send(&mut self.iface)?;
self.addr_mode = AddrMode::Horizontal;
log::debug!("init_column_mode, done.");
Ok(())
}
/// Change the display brightness.
pub fn set_brightness(&mut self, brightness: Brightness) -> Result<(), DI::Error> {
Command::PreChargePeriod(1, brightness.precharge).send(&mut self.iface)?;
Command::Contrast(brightness.contrast).send(&mut self.iface)
}
/// Set the position in the framebuffer of the display where any sent data should be
/// drawn. This method can be used for changing the affected area on the screen as well
/// as (re-)setting the start point of the next `draw` call.
pub fn set_draw_area(&mut self, start: (u8, u8), end: (u8, u8)) -> Result<(), DI::Error> {
self.draw_area_start = start;
self.draw_area_end = end;
self.draw_column = start.0;
self.draw_row = start.1;
self.send_draw_address()
}
/// Send the data to the display for drawing at the current position in the framebuffer
/// and advance the position accordingly. Cf. `set_draw_area` to modify the affected area by
/// this method.
pub fn draw(&mut self, mut buffer: &[u8]) -> Result<(), DI::Error> {
while !buffer.is_empty() {
let count = self.draw_area_end.0 - self.draw_column;
self.iface.send_data(&buffer[..count as usize])?;
self.draw_column += count;
if self.draw_column >= self.draw_area_end.0 {
self.draw_column = self.draw_area_start.0;
self.draw_row += 8;
if self.draw_row >= self.draw_area_end.1 {
self.draw_row = self.draw_area_start.1;
}
self.send_draw_address()?;
}
buffer = &buffer[count as usize..];
}
Ok(())
}
fn send_draw_address(&mut self) -> Result<(), DI::Error> {
Command::PageStart(self.draw_row.into()).send(&mut self.iface)?;
Command::ColumnAddressLow(0xF & self.draw_column).send(&mut self.iface)?;
Command::ColumnAddressHigh(0xF & (self.draw_column >> 4)).send(&mut self.iface)
}
/// Get the configured display size
pub fn get_size(&self) -> DisplaySize {
self.display_size
}
/// Get display dimensions, taking into account the current rotation of the display
pub fn get_dimensions(&self) -> (u8, u8) {
let (w, h) = self.display_size.dimensions();
match self.display_rotation {
DisplayRotation::Rotate0 | DisplayRotation::Rotate180 => (w, h),
DisplayRotation::Rotate90 | DisplayRotation::Rotate270 => (h, w),
}
}
/// Get the display rotation
pub fn get_rotation(&self) -> DisplayRotation {
self.display_rotation
}
/// Set the display rotation
pub fn set_rotation(&mut self, display_rotation: DisplayRotation) -> Result<(), DI::Error> {
self.display_rotation = display_rotation;
match display_rotation {
DisplayRotation::Rotate0 => {
Command::SegmentRemap(true).send(&mut self.iface)?;
Command::ReverseComDir(true).send(&mut self.iface)
}
DisplayRotation::Rotate90 => {
Command::SegmentRemap(false).send(&mut self.iface)?;
Command::ReverseComDir(true).send(&mut self.iface)
}
DisplayRotation::Rotate180 => {
Command::SegmentRemap(false).send(&mut self.iface)?;
Command::ReverseComDir(false).send(&mut self.iface)
}
DisplayRotation::Rotate270 => {
Command::SegmentRemap(true).send(&mut self.iface)?;
Command::ReverseComDir(false).send(&mut self.iface)
}
}
}
/// Set the display contrast
pub fn set_contrast(&mut self, contrast: u8) -> Result<(), DI::Error> {
Command::Contrast(contrast).send(&mut self.iface)
}
}