Skip to content

Commit c6aaab6

Browse files
gamblor21gamblor21
committed
Initial commit
1 parent 24f4d98 commit c6aaab6

File tree

2 files changed

+155
-6
lines changed

2 files changed

+155
-6
lines changed

‎ports/raspberrypi/common-hal/displayio/ParallelBus.c

Lines changed: 146 additions & 6 deletions
Original file line numberDiff line numberDiff line change
@@ -32,37 +32,177 @@
3232
#include "py/runtime.h"
3333
#include "shared-bindings/digitalio/DigitalInOut.h"
3434
#include "shared-bindings/microcontroller/__init__.h"
35+
#include "bindings/rp2pio/StateMachine.h"
36+
#include "common-hal/rp2pio/StateMachine.h"
37+
38+
static const uint16_t parallel_program[] = {
39+
// .wrap_target
40+
// out pins, 8
41+
// set pins 0
42+
//0x6008,
43+
//0xe001
44+
// .wrap
45+
0x6008,
46+
0xB042
47+
};
3548

3649
void common_hal_displayio_parallelbus_construct(displayio_parallelbus_obj_t* self,
3750
const mcu_pin_obj_t* data0, const mcu_pin_obj_t* command, const mcu_pin_obj_t* chip_select,
3851
const mcu_pin_obj_t* write, const mcu_pin_obj_t* read, const mcu_pin_obj_t* reset) {
3952

40-
mp_raise_NotImplementedError(translate("ParallelBus not yet supported"));
4153
// TODO: Implement with PIO and DMA.
54+
55+
uint8_t data_pin = data0->number;
56+
mp_printf(&mp_plat_print, "data pin %d\n", data_pin);
57+
for (uint8_t i = 0; i < 8; i++) {
58+
if (!pin_number_is_free(data_pin + i)) {
59+
mp_raise_ValueError_varg(translate("Bus pin %d is already in use"), i);
60+
}
61+
}
62+
63+
uint8_t write_pin = write->number;
64+
mp_printf(&mp_plat_print, "write pin %d\n", write_pin);
65+
if (!pin_number_is_free(write_pin)) {
66+
mp_raise_ValueError_varg(translate("Bus pin %d is already in use"), write_pin);
67+
}
68+
69+
70+
self->command.base.type = &digitalio_digitalinout_type;
71+
common_hal_digitalio_digitalinout_construct(&self->command, command);
72+
common_hal_digitalio_digitalinout_switch_to_output(&self->command, true, DRIVE_MODE_PUSH_PULL);
73+
74+
self->chip_select.base.type = &digitalio_digitalinout_type;
75+
common_hal_digitalio_digitalinout_construct(&self->chip_select, chip_select);
76+
common_hal_digitalio_digitalinout_switch_to_output(&self->chip_select, true, DRIVE_MODE_PUSH_PULL);
77+
78+
//self->write.base.type = &digitalio_digitalinout_type;
79+
//common_hal_digitalio_digitalinout_construct(&self->write, write);
80+
//common_hal_digitalio_digitalinout_switch_to_output(&self->write, true, DRIVE_MODE_PUSH_PULL);
81+
82+
self->read.base.type = &digitalio_digitalinout_type;
83+
common_hal_digitalio_digitalinout_construct(&self->read, read);
84+
common_hal_digitalio_digitalinout_switch_to_output(&self->read, true, DRIVE_MODE_PUSH_PULL);
85+
86+
self->data0_pin = data_pin;
87+
88+
self->reset.base.type = &mp_type_NoneType;
89+
if (reset != NULL) {
90+
self->reset.base.type = &digitalio_digitalinout_type;
91+
common_hal_digitalio_digitalinout_construct(&self->reset, reset);
92+
common_hal_digitalio_digitalinout_switch_to_output(&self->reset, true, DRIVE_MODE_PUSH_PULL);
93+
never_reset_pin_number(reset->number);
94+
common_hal_displayio_parallelbus_reset(self);
95+
}
96+
97+
never_reset_pin_number(command->number);
98+
never_reset_pin_number(chip_select->number);
99+
never_reset_pin_number(write->number);
100+
never_reset_pin_number(read->number);
101+
for (uint8_t i = 0; i < 8; i++) {
102+
never_reset_pin_number(data_pin + i);
103+
}
104+
105+
uint32_t pin_usage = 0;
106+
for (int pin_number = 2; pin_number < 10; pin_number ++) {
107+
pin_usage += (1 << pin_number);
108+
}
109+
pin_usage += (1 << write_pin);
110+
mp_printf(&mp_plat_print, "pin usage %x\n", pin_usage);
111+
112+
//uint8_t pin_number = digitalinout->pin->number;
113+
bool ok = rp2pio_statemachine_construct(&self->state_machine,
114+
parallel_program, sizeof(parallel_program) / sizeof(parallel_program[0]),
115+
48000000, //125000000, // freq 24Mhz
116+
NULL, 0, // init
117+
data0, 8, // first out pin, # out pins
118+
NULL, 0, // first in pin, # in pins
119+
NULL, 0, // first set pin
120+
write, 1, // first sideset pin
121+
pin_usage, // pins we use
122+
true, // tx fifo
123+
false, // rx fifo
124+
true, 8, true, // TX, auto pull every 8 bits. shift left to output msb first
125+
false, 32, true, // RX setting we don't use
126+
false); // claim pins
127+
if (!ok) {
128+
// Do nothing. Maybe bitbang?
129+
return;
130+
}
131+
mp_printf(&mp_plat_print, "ok %d\n", ok);
132+
mp_printf(&mp_plat_print, "smvalues: %d %d %d\n", self->state_machine.state_machine, self->state_machine.pins, self->state_machine.actual_frequency);
133+
42134
}
43135

44136
void common_hal_displayio_parallelbus_deinit(displayio_parallelbus_obj_t* self) {
137+
for (uint8_t i = 0; i < 8; i++) {
138+
reset_pin_number(self->data0_pin + i);
139+
}
45140

141+
reset_pin_number(self->command.pin->number);
142+
reset_pin_number(self->chip_select.pin->number);
143+
reset_pin_number(self->write.pin->number);
144+
reset_pin_number(self->read.pin->number);
145+
reset_pin_number(self->reset.pin->number);
46146
}
47147

48148
bool common_hal_displayio_parallelbus_reset(mp_obj_t obj) {
49-
return false;
149+
displayio_parallelbus_obj_t* self = MP_OBJ_TO_PTR(obj);
150+
if (self->reset.base.type == &mp_type_NoneType) {
151+
return false;
152+
}
153+
154+
common_hal_digitalio_digitalinout_set_value(&self->reset, false);
155+
common_hal_mcu_delay_us(4);
156+
common_hal_digitalio_digitalinout_set_value(&self->reset, true);
157+
return true;
50158
}
51159

52160
bool common_hal_displayio_parallelbus_bus_free(mp_obj_t obj) {
53-
return false;
161+
return true;
54162
}
55163

56164
bool common_hal_displayio_parallelbus_begin_transaction(mp_obj_t obj) {
57-
58-
return false;
165+
displayio_parallelbus_obj_t* self = MP_OBJ_TO_PTR(obj);
166+
common_hal_digitalio_digitalinout_set_value(&self->chip_select, false);
167+
return true;
59168
}
60169

61170
void common_hal_displayio_parallelbus_send(mp_obj_t obj, display_byte_type_t byte_type,
62171
display_chip_select_behavior_t chip_select, const uint8_t *data, uint32_t data_length) {
63172

173+
displayio_parallelbus_obj_t* self = MP_OBJ_TO_PTR(obj);
174+
175+
/*mp_printf(&mp_plat_print, "send bt %d cs %d dl %d data: ", byte_type, chip_select, data_length);
176+
int max = 8;
177+
if (data_length < max)
178+
max = data_length;
179+
for (int i = 0; i < max; i++) {
180+
mp_printf(&mp_plat_print, "%x ", data[i]);
181+
}*/
182+
183+
common_hal_digitalio_digitalinout_set_value(&self->command, byte_type == DISPLAY_DATA);
184+
//mp_printf(&mp_plat_print, ".");
185+
186+
//for (int i = 0; i < data_length; i++) {
187+
//common_hal_digitalio_digitalinout_set_value(&self->write, 0);
188+
//pio_sm_put_blocking(self->state_machine.pio, self->state_machine.state_machine, *data);
189+
//common_hal_digitalio_digitalinout_set_value(&self->write, 1);
190+
//mp_printf(&mp_plat_print, "%x", *data);
191+
//data++;
192+
//}
193+
//pio_sm_put_blocking(self->state_machine.pio, self->state_machine.state_machine, 255);
194+
//bool success = common_hal_rp2pio_statemachine_write(&self->state_machine, data, data_length);
195+
//common_hal_mcu_delay_us(50000);
196+
//pio_sm_put_blocking(self->state_machine.pio, self->state_machine.state_machine, 0);
197+
//common_hal_mcu_delay_us(50000);
198+
199+
bool success = common_hal_rp2pio_statemachine_write(&self->state_machine, data, data_length);
200+
201+
//mp_printf(&mp_plat_print, "%d", success);
202+
//mp_printf(&mp_plat_print, ",");
64203
}
65204

66205
void common_hal_displayio_parallelbus_end_transaction(mp_obj_t obj) {
67-
206+
displayio_parallelbus_obj_t* self = MP_OBJ_TO_PTR(obj);
207+
common_hal_digitalio_digitalinout_set_value(&self->chip_select, true);
68208
}

‎ports/raspberrypi/common-hal/displayio/ParallelBus.h

Lines changed: 9 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -28,9 +28,18 @@
2828
#define MICROPY_INCLUDED_RASPBERRYPI_COMMON_HAL_DISPLAYIO_PARALLELBUS_H
2929

3030
#include "common-hal/digitalio/DigitalInOut.h"
31+
#include "bindings/rp2pio/StateMachine.h"
32+
#include "common-hal/rp2pio/StateMachine.h"
3133

3234
typedef struct {
3335
mp_obj_base_t base;
36+
digitalio_digitalinout_obj_t command;
37+
digitalio_digitalinout_obj_t chip_select;
38+
digitalio_digitalinout_obj_t reset;
39+
digitalio_digitalinout_obj_t write;
40+
digitalio_digitalinout_obj_t read;
41+
uint8_t data0_pin;
42+
rp2pio_statemachine_obj_t state_machine;
3443
} displayio_parallelbus_obj_t;
3544

3645
#endif // MICROPY_INCLUDED_RASPBERRYPI_COMMON_HAL_DISPLAYIO_PARALLELBUS_H

0 commit comments

Comments
 (0)